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ve ABSTRACT 


A position measuring system for a remotely controlled video camera was designed 
and built. The camera is intended to be used with the modified Advance Development 
Model of the AN’SAR-8 Infrared Search and Target Designation System (IRSTD) in 
use at the Naval Postgraduate School. The video data collected by the camera will be 
correlated with the infrared data from the IRSTD to develop a background data base 
that will be used in the developement of signal processing algorithms. = A 

The measurement system uses two Hewlett Packard HEDS-6000 incrementat optical 
encoders, two Motorola MC68705U3 microprocessors and two digital display devices to 
measure and present the camera’s azimuth and elevation angles to an operator at a re- 
mote location. The azimuth can be measured over a range of 360° with a resolution of 

_*0.0213° and the elevation can be measured over 24° with a resolution of i 0.138°. 
The resolution is limited primarily by hysteresis, which is due to the backlash in the gears__ sat, 
between the transducers and the axes of interest. { a1 4 
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THESIS DISCLAIMER 


The reader is cautioned that computer programs developed in this research may not 
have been exercised for all cases of interest. While every effort has been made, within 
the time available, to ensure that the programs are free of computational and logic er- 


rors, they cannot be considered validated. Any application of these programs without 
additional verification is at the risk of the user. 
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I. INTRODUCTION 


A. BACKGROUND 

The old saying that “every solution breeds new problems”, while somewhat pessi- 
mistic, quite often rings true in today’s increasingly technical world. One such example 
is the use of infrared (IR) sensors for the detection, tracking and, or identification of 
targets in a combat environment. IR sensors are ideally suited for use on today’s bat- 
tlefield. They are passive, i.e., they do not need to emit energy in order to detect the 
presence of potential targets. This allows them to operate during times of emission 
control when many other target detection systems are useless. They have the ability to 
“see through” manv forms of camouflage and concealment, dust, clouds, smoke, etc., 
that might otherwise afford an enemy target a safe haven. Additionally, because almost 
everything on today’s battlefield generates some degree of infrared energy, IR sensors 
can be used to locate and identify a wide variety of targets. 

The extent to which a particular IR sensor is useful depends primarily on its ability 
to detect and identify targets reliably and accurately. Detection of the target is primarily 
a function of the IR sensor’s sensitivity. The classification of a received IR signal as a 
potential target or as background noise, while still dependant on the sensitivity of the 


sensors, is primarily a function of the quality of the signal processing algorithms being 


used to process the received signals. In addition to being reliable these algorithms must 
be able to process the received signals in “real time” if the system is to be an effective 
Weapons system. 

Creation of a background data base that can be used to test some of these algo- 
rithms has been one of the tasks being performed by the Naval Academic Center for 
Infrared Technology (NACIT) located at the Naval Postgraduate School (NPS). The 
Advanced Development Model (ADM) of the AN/SAR-8 was sent to the NACIT in 
January of 1984 from the Naval Surface Weapons Center (NSWC) at Dahlgren, 
Virginia. The ADM was modified, calibrated and placed in service at NPS in December, 
1987. The modified version of the ADM, the Infrared Search and Target Designation 
(IRSTD) System, is currently operational at NPS. [Ref. 1: pp. 8-12] 

One way to enhance the usefulness of the IR data being collected at NPS would be 
to collect video data concurrently with the IR data. A video image of a portion of the 


horizon would permut visual identification of IR sources in that region. This additional 





tional information could be an aid in the development of the signal processing algo- 
rithms for the IRSTD. Accordingly, a decision to proceed with video data collection 
was made by NACIT, and a camera system was purchased. Components of the svstem 
include; 
e RCA (TC1005/01), Closed circuit video camera. 
¢ PELCO (AI700), Automatic iris servo. 
¢ PELCO (F1.5X), 1.5 times range extender. 
PELCO (MLZ6DT), Desk top lens remote control module. 
PELCO (PT1250DC), Heavy duty Pan/Tilt servo. 
PELCO (MPTVISIODT), Pan/Tilt remote control unit. 
Panasonic (WV-5410), Video Monitor. 


In Ref. 1 Ayers describes the IRSTD’s detectors: 


The IR detectors consist of two vertical arrays of sensing elements in the focal plane 
of the Schmidt telescope. The telescope is rotated so as to sweep the image across 
the detector arrays. Each array incorporates a column of 90 indium antimonide 
photovoltic linear detector elements. These two arravs are independent of each 
other and are covered by filters which pass selected wavebands of IR radiation in the 
3 to 5 micrometer range. Each element has the angular dimensions of 2 X .3 
milliradians with the larger being its height. Designated as the lead and the lag, 
these two arrays are separated by about one-half degree in azimuth. [Ref. 1: p. 17] 


Thus, as the IRSTD scans the horizon the resulting IR image has a resolution of ap- 
proximately 10-* radians (0.00573°) in the horizontal plane and 0.23° in the vertical 
plane. The video system's smaller field of view can be remotely controlled using the 
control units listed above. Thus, for the video data to be of any use in the development 
of the signal processing algorithms, the camera’s orientation must first be known, and, 
in order to determine the pixel-to-pixel correlation between the IR image and the video 


image, the position of the video camera needs to be known with the same kind of accu- 


racy as the IR image. The design and implementation of a position measuring system 
for this remotely controlled video camera is the subject of this thesis. 


B. DESIGN SPECIFICATIONS 
The design specifications for this problem were relatively straight forward. The po- 
sition measuring system necJed to meet the following criteria. 


e The system should be able to measure the elevation angle (tilt), above and below 
the horizontal reference plane of the camera over a range of + 12°. 


e The measured elevation angle should be accurate to within + 0.23°. 





The system should be able to measure the bearing (pan), left or right of some ar- 
bitrary reference, of the camera over a range of 360°. 


The measured bearing should be accurate to within + 10~ radians. 


The output should be displaved in a convenient form. The display should be 
collocated with the camera servo remote controls, an indoor site approximately 200 
meters away from the camera. 


Portions of the measuring system required to be collocated with the camera should 
be weatherproofed. 


The system must be reliable and should be simple to operate. 


II]. DESIGN STRATEGY 


A. GENERAL 

A position measuring system, like any system, is a combination of devices intercon- 
nected to perform a certain function. The most basic position measuring system (see 
Figure 1) consists of only four such devices: a transducer, a signal conditioner, a display 
device and a power supply. More complicated position measuring systems include those 
designed to take a number of different measurements either simultaneously or consec- 
utively. Still more complex systems multiplex these various measurements over a single 
channel to some distant location where they can be processed and displayed. [Ref. 2: 
pp. 2-14] 

The design specifications for the camera position measurement system (subsequently 
referred to as the “measurement system”) required that two measurements, pan and tilt, 
be taken simultaneously and transmitted some distance to a remote display. Two sepa- 
rate transducers, capable of independent operation, were therefore required. In order for 
both the azimuth and the elevation to be displayed simultaneously two displav devices 
were also required. 

Several pairs of RG-178 coaxial cable were available to transmit signals between the 
camera servo and the remote control site. Since the cable was available and it was de- 
sirable to reduce the system complexity, a decision was made not to multiplex the data 
over a single channel. Instead, each measurand would have a separate transducer, a 
dedicated signal processor and a unique display device. Position information for each 
axis would be transmitted over a dedicated channel. 

The physical locations of the transducers and the display devices were dictated by 
the design specifications; however, there was some flexibility in deciding where to locate 
the signal conditioner. Site selection was based on an attempt to maximize total system 


performance and simplicity while ensuring the maintainability and environmental integ- 


rity of the signal conditioner. The only advantage to locating the signal conditioner with 


the camera servo and the transducer would have been to limit the distance that the 
transducer’s output signal would have to be transmitted to the processor. On the other 
hand, separating the signal conditioner and the transducers would limit the distance over 
which the conditioned signal would have to be transmitted to the display device. The 


trade-off here was not clear cut and would probably depend on the specific hardware 
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Figure !. Basic Electronic Position Measuring System: From Ref. 2: p. 2 


used and the speed of rotation of the camera servo. There was one significant advan- 
tage, however, to collocating the display and the signal processor; since they would both 
be indoors, the need for weatherproofing the signal processor would be eliminated. 

Powcr was available at both ends of the system, there was therefore no requirement 
to have a common power supply for the entire system. One supply could be used to 
provide power to the two transducers, collocated with the camera servo, and a second 
supply could power the signal conditioner and the displays. 

A block diagram of the prototype measurement system is shown interconnected with 
the camera positioning system in Figure 2. Once this basic system layout had becn de- 
termined, proper selection of the actual hardware was necessary. The design criteria 
were the primary consideration in the initial stages of the hardware selection. Final se- 
lection of the specific components, however, involved balancing additional factors, such 


as availability and cost against the system requirements. 
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Figure 2. Camera Position Measuring System 


B. TRANSDUCERS 
1. General 

Since in practice most measurement systems do not have the ability to respond 
directly to the measurand, transducers are used to convert one physical quantity (e.g., 
angular position) into another, more usable quantity or signal (e.g., an electrical signal) 
[Ref. 3: p. 1-4]. The transducer is therefore a vital part of any measurement system, and 
although none of the components of this system could have been chosen independently 
of the other elements, proper transducer selection appeared to be the key to meeting the 
design specifications. Thus, selection of a transducer was the next step in the design 
process. 

Using the selection guidelines given by Norton on pages 51-53 of Ref. 2 and the 
design criteria stated previously, several observations and decisions were made which 
significantly reduced the number of transducers considered feasible for use in the meas- 
urement system. The fact that the servo was capable of rotating the camera left or right, 
and up or down suggested that the transducer should be capable of detecting both in- 
creasing and decreasing angles on both axes. Additionally, since the servo was antic- 
ipated to rotate the camera through one 360° arc in the horizontal plane, the transducer 
used to measure this angle (subsequently referred to as the “pan transducer”) needed to 
have a comparable range capability. The range requirement for the “tilt transducer” 
(used to measure the elevation angle) was much less restrictive. These factors, angular 
bidirectional capability and full scale range, eliminated a great number of transducers 
from the list of candidates. 

The list was further narrowed by the accuracy requirements previously specified. 
Again the accuracy in the horizontal! plane placed a much more severe limitation on the 
selection of a transducer than the accuracy requirements for the vertical plane. The 
following paragraphs in this section outline the logic used in the selection of the 
transducers. The factors considered in the selection process included the following; 

e The accuracy requirements given in the specifications. 
e The ease with which a specific transducer could be installed on the servo. 


¢ The ability to weatherproof the servo and the transducer once the transducer was 
installed. 


e The rotation speed of the camera about the servo axes. 


e The extent to which a particular transducer/mounting configuration would modify 
the measurand. 


® Cost effectiveness. 


e Availability. 
e Signal conditioning requirements. 
e The extent to which the selection of a particular transducer would simplify or 
complicate the modification or expansion of the measurement system. 
2. Transducer technologies 
Displacement transducer technologies fall into three very broad categories de- 
pending on whether they are capable of measuring linear or angular displacement, or 
both. Some technologies could be eliminated immediately since they were clearly not 
suited for measuring angular position. Strain gauge displacement transducers, inductive 
displacement transducers and vibrating-wire displacement transducers are examples of 
such devices. The following paragraphs briefly describe the different transducer tech- 
nologies which were investigated. Table 1 on page 18 summarizes the salient points of 
the discussion. [Ref. 2: pp. 90-117]. 
a. Reluctive Displacement Transducers 
The rotary variable differential transformer (RVDT), which operates by 
detecting a change in the reluctance between coils, offers excellent resolution, dynamic 
characteristics, linearity and life expectancy [Ref.3: p. (2-14)]. Figure 3 shows a sche- 
matic diagram and a simplified cross-section of an RVDT. The ferromagnetic, 
cardioid-shaped core is attached to a shaft as shown. As the shaft rotates, the inductive 
coupling between the primary and each of the secondary coils changes. When the cam 
is symmetric with respect to the two secondary coils, their output voltages are equal but 
opposite in phase which results in a differential output voltage of zero. As the shaft 
rotates away from this “null” the differential output voltage varies as shown in 
Figure 4. The linear region of the curve is limited to the angles between + 40° of the 
reference. Thus, the RVDT could not be used on the Pan axis. It was however, initially 
considered as a candidate for the Tilt transducer. (Refs. 2: pp. 93-99, 3: 
pp. (9-10)-(9-13) and 4: p. 19] 
Another type of reluctive displacement transducer is manufactured by 
Farrand Controls. Their INDUCTOSYN rotary position transducers have accuracies 
to + 1.5 arc sec (=(4 x 10~“)°). Unfortunately, these devices are 11.89 inches in diameter, 
and mounting them on the camera servo would have been extremely difficult, if not im- 
possible. [Refs. 2: pp. 89-111, 5] 
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Figure 3. RVDT Schematic: From Ref. 2: p. 98. 


b. Capacitive Displacement Transducers 
Angular displacement can also be measured by coupling the rotating com- 
ponent to the shaft a of variable capacitor in the manner shown in Figure 5. Lenk de- 
scribes the operation of the capacitive displacement transducer quite succinctly. 
The capacitor ... consists of a metal plate that moves between two fixed metal plates 
as a shaft is rotated. The three plates, and the air between them, form a capacitor 
with a capacitance that varies in proportion to the degree to which the plates are 


meshed. When the plates are completely meshed, the capacitance is at its maximum. 
When the plates are completely unmeshed, the capacitance is at minimum. [Ref. 4: 


p. 18} 

Capacitive displacement transducers offer many of the advantages of reluc- 
tance displacement transducers. Thev have an effective range of about 300° which, while 
better than the RVDT’s range, is still not adequate for the pan axis [Ref. 4: p. 18). Ad- 
ditionally they are more sensitive to changes in the ambient temperature. Since the 
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Figure 4. RVDT Output Characteristics: From Ref. 2: p. 95. 
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Figure §. Capacitive Displacement Transducer: Ref. 4: p. 18. 


measurement system was being designed to be used outdoors, the use of a capacitive 
displacement transducer would have required the addition of a temperature compensator 
in the design. While possible, this would have increased the system complexity consid- 
erably. [Ref. 2: pp. 90-91) 


c. Potentiometric Displacement Transducers 

Another very common and relatively simple family of transducers operate 
by measuring the change in resistance caused by a change in the measurand. There are 
a wide variety of such devices available. The basic form of potentiometric angular dis- 
placement transducers uses a resistance element, formed into an arc, and a movable 
electrical contact that rotates about the axis of interest. By measuring the change in 
resistance that results from a change in position, one is able to determine the angular 
displacement. The resistive element is typically a wirewound element, the resolution of 
which is determined by the number of turns per unit length of the resistance element. 
The angular resolution can be increased by increasing the turn density (wires/degree) of 
the potentiometer. 

The practical limit for wire spacing on wirewound elements according to 
Ref. 6 is between 500 and 1000 turns per inch. From Figure 6 one can see that this 
limits the angular resolution for a single-turn device to 


Ax (in) 
A@(rad)= tan “RGin) ) (1) 


Therefore, 


2Ax _ 9.002(in) 


D Diin) (2) 








A@(rad)~ 


To achieve the 10-* rad resolution, specified for the Pan axis, with a single turn 
potentiometer would therefore require a 20 in diameter potentiometer. Mounting a de- 
vice this large on the camera servo was simply not feasible. Potentiometers are, how- 
ever, available with multiple turns. Shaped in a helix fashion similar to that shown in 
Figure 7, the total length of the potentiometer can be increased, which in turn increases 
its resolution, Without increasing the diameter of the device. 

Increasing the resolution of the potentiometer by increasing the turn density 
in any of the manners described above, however, increases the output impedance of the 
device, which leads to increasing nonlinearity between the measurand and the transducer 


1] 


Figure 6. 
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Geometry of an Angular Potentiometric Transducer 
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Figure 7. 


output. 





Multiturn Potentiometer: From Ref. 6: p. 218 


Figure 8. In the diagram the following variable definitions apply: 


Assuming that R,is uniformly distributed over x,, analysis of the voltage divider circuit 


€x = Input voltage, 

e, = Output voltage, 

R, = Total resistance of the potentiometer, 
R,, = Meter resistance, 

x, = Total range of the potentiometer, and 


x, = Actual displacement of the potentiometer. 


gives, 


13 


The nonlinear relationship can be seen by analyzing the circuit shown in 





Figure 8. Potentiometric Transducer: From Ref. 6: p. 219 


Thus, the ideal (i.e., linear ) relationship, 


is true only when R,:R,,=0, and since R, # 0, and R,, # 00, the nonlinear relationship in 
(3) will always exist. Doebelin states that “for values of R,/R, <0.1 the position of 
maximum error occurs in the neighborhood of x,/x,= 0.67, and the maximum error is 
approximately 15(R,/R,,) percent of full scale.” [Ref. 6: p. 218] Other potentiometric 
transducers, which use a resistive element made of carbon film or a conducting plastic, 
are not subject to the same kind of resolution limitations as wirewound devices; however, 
they do have high output impedances and the corresponding nonlinearities described 
above. (Ref. 6: pp. 217-224} 

A high quality multiturn potentiometer used in conjunction with a high 
quality voltmeter offered one possible solution to the design problem. However, the 
nonlinearity of this arrangement was a significant disadvantage, and the primary reason 


why potentiometers were not used. 
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d. Encoders 

The angular displacement transducer, referred to in general as an angular 
encoder or shaft encoder, converts an angular displacement into a digital signal without 
the use of an analog-to-digital converter. In today’s increasingly digital world this can 
be a distinct advantage. 

There are three different transduction methods used in encoders. Magnetic 
encoders use a pattern made from magnetized and nonmagnetized segments and one or 
more magnetic sensors that register as either “1’s” or “0's” depending on the magnetic 
characteristics of the section that they are adjacent to. Brush-type encoders are similar, 
but the sections are made of conducting and nonconducting materials. The conductors 
are all tied to a common source and the “sensor” is one or more brushes connected to 
the output. When the brush is in contact with one of the conductors the output is 
“on” and when the brush is in contact with an insulator the output is “off. Optical 
encoders (See Figure 9) use a pattern of opaque sections marked on an otherwise 
transparent disk. A light emitting diode (LED), or other light source, is placed on one 
side of the disk, and as the disk rotates a light sensor on the other side of the disk 
“sees” periods of dark and light which it converts into a-digital signal. (Ref. 2: p. 106] 

Angular encoders are further categorized as either absolute encoders or in- 
cremental encoders. Absolute encoders, similar to the optical encoder shown in 
Figure 9, use a multitrack pattern on a code wheel to produce a unique coded output 
signal for each incremental change in the measurand. These wheels use a variety of 
codes, including binary code, binary-coded decimal (BCD) and Gray code, to determine 
the shaft position. The resolution of an absolute shaft encoder is limited by the number 
of tracks on the disk and the type of code used. A simple binary or Gray code encoder, 
which are more efficient than the BCD encoders, with N tracks has an optimum angular 


resolution of 


360 
<a (5) 


A@ = 





Thus, to achieve the desired resolution of 10- radians on the Pan axis with an absolute 
encoder would require a code wheel with N 2 16. Since the output from the encoder is 
unique for each position, these devices are not affected by power outages, and the re- 
quirements for a signal processor for such a device would be limited to a simple decoding 


circuit. These encoders can measure angles of up to 360° without ambiguity. 
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Incremental encoders use a code wheel which has only one track. As the 
shaft of the incremental encoder rotates the output from the encoder is a series of 
equally spaced pulses. These pulses can then be used as an input signal to an up,down 
(UD) counter of some sort. The output from the counter is an indication of the dis- 
placement of the axis from some predetermined reference. The resolution of an incre- 
mental encoder is a function of the number of pulses the code wheel generates per 


revolution and is given by; 


360° 


Ad = PPR (6) 


where PPR is the number of pulses per revolution of the code wheel, and n is the number 
of revolutions that the code whee! makes per revolution of the axis of interest. If the 
incremental shaft encoder was mounted on the shaft of interest (n= 1) at least 62,832 


PPR would be required to ensure a resolution of 10~ radians. 


eee 


gage Coded disk 


Light sensor 


Light source assembly 
Reading tine 





Figure 9. Absolute Photoelectric Angular Encoder: (a) typical code disk; (b) en- 
coder elements. From Ref. 2: p. 107. 


Shaft encoders currently range in price from less than $100.00 to several 
thousand dollars depending on their capabilities and the method of transduction used. . 
Litton Encoder’s Model 60 absolute shaft encoder uses a natural binary code, has 15 
tracks (0.1917 mrad resolution) and is available “off the shelf for approximately $3000. 
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Other absolute encoders with comparable resolutions are available at similar prices. No 
incremental encoders were found which offered the same kind of resolution as Litton’s 
Model 60; however, because they are not limited to one revolution of the axis, the re- 
solution of an incremental encoder can be improved by a factor of n by causing its code 
wheel to rotate n times for every rotation of the axis of interest. Incremental encoders 
with 1024 PPR are available from a variety of manufacturers for about $100 each. 
Connecting such a device to the axis of interest via a gear train with a 50:1 ratio would 
theoretically result (from (6)) in a resolution of 0.1227 mrad. Incremental encoders do 
require more complex signal processing than absolute encoders, and they are affected 
by power shut-off. Additionally, unlike absolute encoders, any missed or erroneous 
count that occurs with an incremental encoder will cause a persistent error. [Ref. 7: 
p. 16] 

After considering the measurement system performance criteria and the ca- 
pabilities and limitations of the various transducers, the use of an incremental, optical 
shaft encoder appeared to be the best selection for the transducer for each axis. This 
decision involved balancing the various advantages and disadvantages of the different 
transducers. The following list gives a summary of the key considerations in this deci- 


sion. 


e Small. lightweight, highly accurate and relatively inexpensive models were readily 
available. Being small and lightweight suggested that mounting and 
weatherproofing the transducers in the camera servo should not be too difficult. 


e Absolute encoders offer almost all of the advantages of the incremental encoders, 
they are not affected by power outage, they require less complex signal processing 
and one time counting errors do not persist. However, these features did not seem 
to justify the additional price of an absolute encoder. 


e Linearity and loading problems associated with the potentiometric displacement 
transducers were avoided. 


e Direct conversion of the measurand into a digital signal precluded the requirement 
for an A'D converter. (This would have been a disadvantage had the use of an 
analog signal conditioner been anticipated.) 


e Using two identical transducers, each capable of meeting the specifications for the 
pan axis, would reduce system complexity while still ensuring that the design spec- 
ifications Were met. 


C. MOUNTING THE TRANSDUCER 
Once the decision to use an incremental optical shaft encoder was made, selection 
of a specific model remained. Before selection of an actual piece of hardware could be 
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Table 1. ANGULAR DISPLACEMENT TRANSDUCERS 
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done though, one additional practical consideration had to be made; where and how 
could a transducer be mounted in or on the servo in order to measure the position of the 
Pan and Tilt axes? 

The physical layout of the camera positioning servo made direct connection of any 
type of transducer to the axes of interest virtually impossible without major modification 
of the servo itself. Major modification of the servo would have been expensive, time 
consuming and outside the scope of this thesis. It was not considered an option in this 
case. Measurement of the Pan and Tilt axes’ displacements was most readily accom- 
plished indirectly. Each axis of the servo is positioned by a separate dc motor via a gear 


train. By mounting the shaft encoder code wheels to the sprockets (items 42 and 43 in 
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Figure 10) which are each attached to one of the worrns, an indirect measurement of the 
position of each of the wormgears (items 5 and 7 in Figure 10) was possible. This ap- 
proach, made necessary by the servo design, was a mixed blessing. 

The backlash in a Worm-wormgear connection will cause the position of the worm 
to be different for anv given wormgear position, depending cn whether that position is 
approached from a clockwise or a counterclockwise direction. In order to correctly de- 
termine the displacement of the wormgear by measuring the displacement of the worm, 
the amount of backlash present must be known (i.e., would have to be determined ex- 
perimentally) and accounted for by the measurement system. This nonlinear source of 
error would not have been a concern if the servo was only required to rotate in one di- 
rection. This was not the case, however, and hysteresis eventually was determined to 
be the largest single source of error in the measurement system. A more complete dis- 
cussion of this topic is included in Chapter IV of this thesis. 

Assuming for the moment that the effects of the backlash in the gears could have 
been completely compensated for, mounting the shaft encoders on the worm provided 
a measurement advantage analogous to the mechanical advantage afforded by the gear 
train. Initial measurements indicated that each of the worms turned through 18,000° 
(50 x 360°) for every 360° rotation of the corresponding wormgear. This meant that a 
shaft encoder with 100 divisions per 360° attached to the worm axis could do the same 


job as a 5,000 division per 360° encoder attached to the wormgear axis. 


D. SELECTING AN OPTICAL SHAFT ENCODER 

Once the basic decisions to use incremental optical shaft encoders and to mount the 
encoders on the worms inside the servo housing had been made, selection of the specific 
pieces of hardware was relatively straight forward and was primarily a matter of con- 
venience and expediency. 

Returning to the design specifications for a moment; the most stringent requirement 
was to be able to measure the position of the pan axis to within + (5.73 x 10-3)°. To 
determine the required resolution for the optical shaft encoder, the following calculations 
were performed. 


First, 


360°/Revolution Divisions 


~62,827 


5.73 x 1073°/Division Revolution 








Camera Servo: From Ref. 8: p. 12. 


Figure 10. 
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Then, considering the 50:1 gear advantage, 


62.827 Divisions 
50 =1257 Revolution 


(8) 


The task therefore was to find an optical shaft encoder capable of detecting 
bidirectional rotation with at least 1257 Divisions; Revolution in a package small enough 
to mount in the servo housing on the worm axis. There was no absolute size limitation; 
however, due to the construction of the servo it was desirable to find an encoder that 
was no more than 3 in. in diameter and no more than 1.5 in. in width. The companies 
that make shaft encoders are capable of custom building devices to meet a customer's 
specific needs. However, the prices are high, and the lead times are long for these special 
order parts. The encoder for this system needed to be reasonably priced and readily 
available to ensure timely completion of the project and to facilitate replacement, if 
necessary, in the future. 

Optical shaft encoders are manufactured by numerous companies including Litton, 
Honeywell. BEI, 1VO and Hewlett Packard. Sales literature from these companies was 
reviewed prior to making a decision on the specific shaft encoder model to be used. In- 
cremental optical shaft encoders with resolutions that range from one pulse per revo- 
lution (PPR) to 2540 PPR are available off the shelf from one or more of these 
companies. While evaluating sources of supply, incremental optical shaft encoders were 
also found in use in various iaboratories and shops in the Electrical Engineering and 
Physics Departments at the NPS. Encoders immediately available from stock included 
two Vernitech 1200 PPR (model VOE-23-1200-AI-LD5-2L1-1603-2) encoders from the 
Physics Department and two Hewlett Packard (HEDS-6000.J06) encoders from the 
Electrical Engineering Department. The use of the Vernitech encoders was ruled out 
because they were unable to detect bidirectional movement without increasing the com- 
plexity of the signal conditioning subsystem. Additionally, technical literature requested 
on two separate occasions from Vernitech was never received. 

The HEDS-6000.J06 encoders have a resolution of 1024 PPR. Each encoder pro- 
vides displacement information in the form of TTL logic level signals via two output 
channels. When the encoder is properly adjusted the two output signals have a 90° 
phase difference. This quadrature phase relationship permits these encoders to detect 


bidirectional displacements. Rotation in one direction will cause Channel A to lead 


Channel B (in phase), while rotation in the other direction will cause Channel B to lead 
Channel A. [Ref. 9: p. 2] 

The presence of two output channels in quadrature phase has an additional benefit 
that is useful in some applications. Since the amount of position information has es- 
sentially been doubled, if the signal conditioner is designed to detect both the leading and 
trailing edges of one of the output channels the resolution of the measurement system 
can be doubled. The difficulty with using this technique is that multiple oscillations 
about a single point cannot be detected as such. If the camera were to oscillate less than 
one half of a pulse width about a transition the signal conditioner would detect and er- 
roneously count the multiple transitions. [Ref. 7: pp. 13-16] 

With 1024 PPR, which is less than the 1257 PPR required to meet the 0.1 milliradian 
accuracy specification on the pan axis, the maximum resolution available, if the 


HEDS-6000 was attached to the worm, can be calculated as; 


360° 


T50 x lozay 7 (7.03125 x 107°)? Pulse"! . (9) 


Although this wes not sufficient to satisfy the pan axis resolution specification of 
(5.73 x 10-3)°Pulse,-! all of the other performance criteria could be satisfied. The trade- 
off seemed reasonable and was approved prior to proceeding further with the system 


design. 


E. THE DISPLAY 

Selecting a method to display the fina] system output was certainly the least de- 
manding task required in the design of the system. With an expected resolution on the 
pan axis of approximately 0.007° over a range of 360° (a ratio of about 1:51.500) an 
analog display seemed out of the question. A five or six digit digital display on the other 
hand offered a simple, reliable and cost efficient means of presenting the output. Con- 
structing the displays from individual, seven-segment, common anode, LED devices, and 


the appropriate display drivers was a straight forward task. 


F. THE SIGNAL CONDITIONER 

Antucipating the use of two incremental shaft encoders as the transducers for the 
measurement system and the use of digital readouts as the display devices significantly 
reduced the number of possibilities for the signal conditioning subsystem. In addition 


to the hardware and software described in each of the subsequent discussions, each 
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technique listed here would require an edge detector to detect the transitions in the TTL 
signals from the shaft encoders. 

¢ Up.down counter with table look-up. 

¢ Up/down counter and multiplication. 

e Add’subtract. 

@ Microcomputer. 


© Microprocessor. 


1. Up/down (U/D) counter with table look-up 

This technique would involve the use of a shift register, some associated logic, 
an LD counter and a table look-up device such as an erasable programmable read only 
memory (EPROM). The shift register would serve as a hardware buffer that could be 
used to account for the hysteresis introduced by the worm-wormgear assembly. The 
length of the buffer would have to be determined experimentally. The logic associated 
with the shift register would determine the “validity” of each transition (count) signal 
from the edge detector by checking the contents of the shift register and comparing the 
current direction of rotation with the previous direction of rotation. Whenever the logic 
detected a change in rotation direction, or a partially full, or a partially empty buffer 
(depending on the direction of rotation), the transition would not represent a “valid” 
count since any of these conditions would indicate that the transition was due to a 
change in the position of the worm without a corresponding change in the position of 
the wormgear. Thus, the present transition would be the result of hysteresis due to the 
backlash in the gear train and the transition would be “invalid”. Such a transition would 
cause the contents of the hysteresis buffer to be modified appropriately. A more com- 
plete discussion of this topic is contained in Chapter IV. The shift register and associ- 
ated logic could be built from common TTL devices readily available at the NPS. 

Once a count had been determined to be valid, an UD counter would be used 
to keep a running total of the number of counts. Again, such a device could be built 
using readily available TTL devices such as the 74LS168A, Synchronous 4-Bit Up/Down 
Decade Counter, or the 74LS169A, Synchronous 4-Bit Up,;Down Binary Counter. The 
output from the U,D counter would then be used as an address to “look up” a prede- 
termined number stored in an EPROM. 

This design approach was considered relatively straightforward, and at least in- 
itially seemed like a viable option. Its major advantage was that it was conceptually 
quite simple. This simplicity had a price though; it would have been very hardware in- 


tensive and consequently would have been a very inflexible design. For example, if at a 
later date the use of an arbitrary reference was desired, additional hardware would have 
to be added to the signal conditioner so that the counter could be initialized to the ar- 
bitrary starting point. Since all of the processing would have to be done in hardware, 
even a minor modification in the system could necessitate a major design revision. An- 
other consideration was that saving in excess of 51,000 unique positions in the EPROM 
presented a nontrivial problem that would need to be solved if this technique was used. 
2. Up/down counter and multiplication 

This is very similar to the previous case, differing only in that instead of looking 
up a predetermined position, in a memory device, a multiplier would be used to multiply 
the output of the U;D counter by a predetermined constant. As an example, if exper- 
imental results indicated that the shaft encoders generated one pulse for every 
0.00703125° that the camera was displaced, then each time a valid count was received, 
the updated count would need to be multiplied by 0.00703125 in the final stage of the 
signal processor. The result would be the new position. Again, while conceptually 
simple this idea had some significant disadvantages. Even more hardware intensive than 
the first approach, this design would also have extremely limited flexibility. 

Accomplishing the multiplication would have posed a formidable task. The 
scale factor would have to be written as some integer (e.g., 0.00703125 would become 
703122, or 70323, or 7031, etc.) depending on the desired accuracy. The count, already 
an integer, would be multiplied by the constant and the correct position of the decimal 
point would have to be determined. Locating the decimal point would be a relatively 
simple task, but multiplication of two numbers such as 51,000 and 70,313 would not be 
as easy. At least one 16 bit by 16 bit binary multiplier (i.e., TRW’s MPYOI6H) is cur- 
rently available, but since the number 70313 cannot be represented in binary by less than 
17 bits, the multiplication could have been accomplished in either of two ways. One 
solution would have been to perform the multiplication in two or more stages. Alter- 
natively, 70313 could be “rounded” to 7031. The second option would create a cumu- 
lative round-off of about (1.28 x 10-°)° per 360° rotation (assuming 51,200 pulses per 
360° ). This round-off error would probably have been acceptable, but the complexity 
and limited flexibility of either multiplication scheme made the UD counter and multi- 


plication an unacceptable candidate for the signal processing subsystem. 
3. Add/subtract 
A third design concept considered the elimination of the U/D counter alto- 


gether. The same logic proposed for use in the previous two designs could have been 
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used to check the validity of a count and to determine the direction of rotation. How- 
ever, instead of valid counts being sent to an U/D counter as before, these counts would 
now signal an adder to add or subtract a predetermined constant from the running total. 
Just as before, this simple idea could probably have been made to work at least once, 
but its usefulness as a part of a larger system would certainly have been limited. The 
large number of components required to realize this design would have increased the 
probability of failure, complicated troubleshooting and reduced overall flexibility. 
4. Microcomputer 

If the signal processing subsystem was built around a microcomputer (PC), vir- 
tually all of the disadvantages associated with the previously discussed approaches would 
be eliminated. Since all of the logic could be implemented in software, modifications to 
the system would be relatively simple to make, and the system’s flexibility would be en- 
hanced. However, dedicating a microcomputer, even an inexpensive model, to the signal 
processing tasks for this measurement system was considered overkill, and timesharing 
with one of the PC’s already in . rvice was possible, but not considered practical or 
convenient since these microcomputers had already been dedicated to a variety of tasks. 

5. Microprocessor 

One final option for the signal processor remained. Microprocessors are rela- 
tively inexpensive and powerful and are available in a wide variety of makes and models. 
If a microprocessor was used instead of a microcomputer or a straight hardware 
processor, the “nice to have” requirements such as flexibility, ease of modification and 
capacity for expansion, as well as the required signal processing functions could all be 
satisfied. On the other hand, microprocessors have one distinct disadvantage; they are 
not user friendly. The use of a microprocessor implied countless hours spent tracking 
individual bits, debugging assembly language code, studying timing diagrams, etc.. No 
matter how distasteful the thought, however, a microprocessor was clearly the best way 
to perform the signal processing functions of the measurement system. 

As with the selection of the transducer, once the basic design approach had been 
determined, selection of a specific device was a relatively straight forward task. The 
choice of one microprocessor over another was a function of the processor’s ability to 
perform the required tasks, cost effectiveness and availability. Motorola’s MC68705U3 
seemed to satisfy all of these requirements. The MC68705L3 is a four kilobyte EPROM 
microprocessor, built using HMOS (high-density NMOS) technology with an eight bit 
architecture. The “68705” operates on a 5.0 volt de supply, has 112 bytes of on chip 
RAM, four vectored interrupts, 24 TTL:CMOS compatible bidirectional IO lines (eight 
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lines are LED compatible), eight dedicated input lines and an internal eight bit timer 
with a seven bit programmable prescaler. [Ref. 10: p. 1} 
In Ref. 10 Motorola advertises the following software features: 

Programming language similar to the 6800 family. 

Byte efficient instruction set. 

Easy to program. 

True bit manipulation. 

Bit test and branch instructions. 

Versatile interrupt handling. 

Powerful indexed addressing for tables. 

Versatile index register. 

A full set of conditional branches. 

Memory usable as registers/flags. 

Single instruction memory examine/change capability. 

Ten powerful addressing modes. 

All addressing modes apply to EPROM, RAM and I/O. 


One key advantage to using the MC68705U3 was that one of the micro- 
processors, and a Motorola M6870SEVM (the evaluation/programming module for the 
M6805 family of devices) were both available for immediate use at the NPS. The fact 
that the 68705 utilized HMOS technology suggested that it should be a relatively low 
cost microprocessor. In fact, except for the price of a phone call, a second micro- 
processor was obtained free of charge from a local electronics wholesaler. Additional 
microprocessors, to be used as replacements and as backup devices were ordered for 
about $20.00 each. 

One potential problem with using a microprocessor begged checking prior to 
proceeding. Initial measurements of the camera’s maximum rotation velocity produced 
the following results. 


©p4y{ max) = 1.0 rpm (10) 


TILT ( max) ~0.5 rpm (11) 


Again the requirements for the pan axis presented the most stringent design limitations. 
Since the optical shaft encoders were anticipated to deliver 51,200 PPR ( 1024 x 50) the 
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microprocessor on the pan axis had to be capable of processing 51,200 pulses/minute 
(1.172 ms ; pulse). The MC68705U3 is designed to operate with an oscillator frequency 
(f,-) of between 0.4 MHz and 4.4 MHz and has an instruction cycle time (4/f,,.) of be- 
tween 0.950 us and 10 ws. Assuming that a 4.0 MHz clock was used, the instruction 
cycle time would be 1.0 us. This would mean that the processing of each pulse would 
have to be accomplished in no more than 1172 instruction cycles to ensure that no pulses 
would be missed. 
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II. DESIGN 


A. GENERAL 

The schematic diagrams for the measurement system are shown in Appendix A; 
Appendix B contains copies of the printed circuit board plans. Before describing the 
detailed operation of each of the individual components of the measurement system, a 
brief overview of its basic theory of operation is in order. The measurement system is 
actually two separate systems operating independently. The system designed to measure 
the azimuth or pan angle will subsequently be referred to as the “Pan System”, and the 
other system, designed to measure the elevation or tilt angle, will be referred to as the 
“Tilt System”. However, because the two systems are quite similar the discussion which 
follows will only specifically describe the operation of both systems where their opera- 
tion differs. 

In the most general terms, the measurement system shown in Figure 2 on page 6 
uses two microprocessors to count the pulses generated by the incremental shaft encod- 
ers, and to provide output signals to the display devices. The counting function per- 
formed by each microprocessor involves determining the direction of rotation and 
determining whether each count is “vzlid”. Valid counts are encoder pulses which result 
from the displacement of the camera servo, while invalid counts are a result of the 
hysteresis in the gear train. The number of valid counts is directly proportional to the 
angular displacement of the camera axis. 

Both of the displays are capable of presenting the position information in two basic 
forms. In the Count Mode they display the number of pulses that have been detected, 
and in the Position Mode they display the angle in degrees that the number of pulses 
represents. A third display mode, which is a combination of the first two, is also avail- 
able. In the third mode, referred to as the “Blinking Mode”, the display will alternately 
display the count and the angle. 


B. SHAFT ENCODER AND LINE DRIVER 

Figure 11 shows the basic components of the HEDS-6000 incremental optical shaft 
encoder. The encoder is approximately 56 mm in diameter and 20 mm deep. The code 
wheel assemblies for the HEDS-6000'J06 encoders are designed to mount on 0.25 in. 
shafts. Since the mounting surface shown in Figure 1] is not part of the encoder kit, 
and did not existed on either of the worm axes, two such surfaces were machined in the 
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Physics Department Shop and attached to one end of each of the worms. Each surface 
has a 0.25 in. diameter shaft to which one of the code wheel assemblies is attached. Two 
sheet metal brackets, also made in the Physics Department Shop, are bolted to the servo 
frame. The encoder bodies are mounted to these brackets. Figure 12 shows the shaft 
encoders mounted in the camera servo. [Ref. 9: p.1]} 


EMITTER CODE WHEEL PHASE ENCODER MOUNTING 
ENO PLATE ASSEMBLY PLATE BODY SURFACE 





Figure 11. HEDS-6000 Series Encoder Kit: From Ref 9: p.6. 


Also seen in Figure 12 is a printed circuit board mounted between the two optical 
shaft encoders. Each of the encoders is electrically connected to the board via a separate 
ten wire nbbon cable. The power and the output signals from the shaft encoders are 
transmitted through these cables. A sketch of the ribbon cable connector and the pinout 
for the connector are shown in Figure 13. Each connector is attached to a ten pin 
header on the printed circuit board. Pins 2, 7 and 9 are connected to a +5.0 Vdc power 
supply external to the camera servo. A description of the power supply is given later in 
this chapter. Pins 3, 4, 5 and 6 are connected to the power supply ground. The 
HEDS-6000 does not have an index pulse, therefore pin 10 is not connected. 

The remaining two pins on each header connect the output channels of the shaft 
encoders to two 748140 line drivers. Each 748140 is a dual four-input NAND gate 
50-Ohm line driver. The line drivers are powered by the same supply as the encoders. 
They serve as buffers between the encoders and the transmission lines which are used to 


transmut the encoder signals to the signal conditioner. The line drivers’ typical high 
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Fioyrc 12. Modified Camera Servo: (a) Optical shaft encoder used to measure 
Pan axis displacement, (b) Optical shaft encoder used to measure Tilt 
axis displacement, (c) Ribbon cable, (d) Printed circuit board. 


output current is 10 mA and the maximum is 18 mA. Resistance in the transmission 
line was measured to be approximately 35 Q, and to be on the safe side a 10 Q con- 
nector loss was assumed. The voltage drop due to an 18 mA current through a 45 Q 
resistance is 0.81 V. A “voltage high” signal received at the signal conditioner should 
therefore be about 4.19 VY. This is well above the maximum, positive-going threshold 
voltage specification of 2.0 V for the 7414 Schmitt triggers, which are used to receive the 


signals at the signal processor. [Ref. 11: pp. 5-73, 5-74, 6-44] 


C. ENCODER-MICROPROCESSOR INTERFACE 

The signals transmitted by the two line drivers are Channels A and B of each of the 
shaft encoders. These signals contain the raw data which the signal processor converts 
into position information. Three pairs of multiple pin connectors are used in the 


encuder-microprocessor interface. The pinouts for these connectors are shown in 
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PINOUT 


FUNCTION 
CHANNEL A 

Vee 

GROUND 

W.C. OR GROUND 
&.C. OR GROUND 
GROUND 
Vee 

CHANNEL & 

Vee 


BOTTOM VIEW 
CHANNEL 1 


’ 
2 

‘3 
4 
& 
6 

7 
8 
9 

10 





Figure 13. Encoder Connector Specifications: From Ref. 9: p. 6. 


Figure 14. Each of the four signals is received at the signal processor by a 7414 Schmitt 
trigger which is used to “clean up” the signal. The Schmitt triggers lower the system's 
susceptibility to errors caused by slow state transitions and increase the signals’ fan out 
capabilities [Ref. 7: p. 13}. 

The output of each Schmitt trigger is routed to an input port of the appropriate 
microprocessor. Each Channel A signal is also the input to an edge detector. The edge 
detectors each consist of three 7414 inverters, a 74LS86 EXOR gate and a 47 nF 
capacitor, configured in the manner shown in Figure 15. This configuration causes the 
interrupt line to go low for approximately 2 ws each time Channel A transitions from 
Jow to high or from high to low. Since an oscillator frequency, f,,,, of 4.0 MHz is being 
used, the interrupt pulse width, t,,, must be greater than or equa] to 1.25 ys [Ref. 10: 
p. 3}. The value of the capacitor required to achieve the 2 us delay was determined ex- 
perimentally. 


D. SWITCHES 

The measurement system has 10 switches that allow the operator to control specific 
functions of the signal processors and the displays. Figure 16 shows the physical lo- 
cation of these switches on the control panel. Switches SW1(P) and SW1(T) control the 
reset lines to the microprocessors. Switches SW2(P), SW2(T) and SWS control the dis- 
play mode. The Function and Set switches; (SW3(P), SW3(T), SW4(P) and SW4(T)) 


allow the user to change the length of the hysteresis buffer in the microprocessor. The 
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Figure 15. Interrupt Interface: After Ref 7: p. 14. 


master power switch is SW6. Table 2 identifies the switches by name, description and 
function. 

Any mechanical switch will “bounce” or “chatter” when it is thrown, and since the 
operation of the signal processor depends on the nuinber of times that the Display Mode 
and Set switches change position, these switches had to be “debounced”. A very simple 
but effective way to do this is with an RS latch. Switches SW2(I), SW2(T), SW4(P) and 
SW4(T) are each debounced in this manner. Each latch is made from two 74800 NAND 
gates connected in the manner shown in Figure 17. [Refs. 13: pp. 132-135, 12: pp. 3,4] 
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SW 5 Cc LIGHT TEST 


TILT 


RESET SW 1 


DISPLAY MODE SW 2 


FUNCTION (HYSTERESIS) SW 3 


SET (HYSTERESIS) SW 4 





Figure 16. Control Panel 


E. MC68705U3 

1. General 
The two 40 pin MC68705U3 microprocessors (MPU’s) are the heart of the 
measurement system. With the exception of the light test signal, every signal in the 
system is either part of the input to one of the MPU’s or part of their output. The 
MPU’s were programmed using the assembly language syntax, assembler directives and 
instruction set for the M6805 family of microprocessors which are described in Ref. 14. 
The Pan and Tilt programs are listed and their operation is described in Appendix D. 
The pin assignments for the MC68705U3 are shown in Figure 18. Table 3 briefly de- 


scribes the purpose of each pin and the actual connections for the two MPU’s. 
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Figure 17. Debouncing circuit: After Ref 12: p. 4. 


2. Memory Map 
a. Input] Output (1/0) 

The memory map for the MC68705U3 is shown in Figure 19. The digits 
following a “S” are the hexadecimal representation of the address for a specific memory 
location. The data registers occupy the first four memory locations of each MPL. Thus 
the information written into the registers at S000, S001 and $002 is written to the output 
ports A, B and C respectively. Port D, at address $003, is an input only port as indicated 
in Table 3. In order to determine the state of the input lines, the contents of the register 
at $003 must be read by the MPU. Registers $004, $005 and S006 are the data direction 
registers (DDR’s) for Ports A, B and C respectively. Because all three ports are used as 
“output only” ports, in this application, the DDR’s are all established as such by an 
initialization routine performed by the MPU’s during their initial power-up and after 
each external reset. [Ref. 10: pp. 5, 12, 14] 

Pin 18 of the MPU can be used as either a general purpose input line or as 
an interrupt line. The primary interrupt line on each MPU is used to signal the occur- 
rence of a state transition on Channel A. Pin 18 is used as a second interrupt line to 
signal a display mode change request from the operator. The Miscellaneous Register 
(MR) at address SOA is used to control the operation of the second interrupt line 
(INT2) . In order to establish pin 18 as an interrupt line, bit 6 of the MR is cleared by 
the Initialization Routine. The INT2 Interrupt Request Bit, bit 7 of the MR, is cleared 
by default upon reset. It is set when a falling edge is detected on the Display Mode line 
which is connected to pin 18. When this occurs and bit 6 of the MR is cleared, an in- 
terrupt request is generated. This interrupt request causes the display mode to change. 
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Table 2. SIGNAL PROCESSOR AND DISPLAY SWITCHES 


NAME DESCRIPTION AND FUNCTION 7 


PAN RESET Momentary action push button switch: Resets the Pan 
(SW1(P)) Microprocessor. Causes the Pan Display to be reset to 
zero. 


TILT RESET Same as SW1(P) except it affects the Tilt System only. 
(SWI(T)) 


PAN DISPLAY MODE | Single pole double throw toggle switch: Each time the 

(SW2(P)) switch position is changed the Pan Display toggles from 
Count mode, to Position Mode, to Blinking Mode, to 
Count Mode, etc.. 


TILT DISPLAY MODE | Same as SW2(P) except it affects the Tilt Display only. 
(SW2(T)) 


FUNCTION Single pole double throw switch: When closed, causes 
(HYSTERESIS) the “Function” line of the Pan Microprocessor to go 
(SW3(P)) low and causes the size of the hysteresis buffer to be 
displaved on the Pan Display. Enables SW4(P). 


FUNCTION Same as SW3(P) except it affects the Tilt System only. 
(HYSTERESIS) 
(SW3(T)) 


SET HYSTERESIS 
(SW4(P)) 

























































Single pole double throw switch: Inoperable unless 
SW3(P) is closed. If SW3(P) is closed, each time the 
position of SW4(P) is changed the length of the 
hysteresis buffer is incremented by one. Maximum 
buffer length is 25. Toggling SW4(P) when the buffer 
length is 25 will cause the buffer length to be reset to 
zero. 


SET HYSTERESIS Same as SW4(P) except it affects the Tilt Hysteresis 
(SW4T)) buffer. 


LIGHT TEST Single pole single throw switch: When closed, lines 1, 

(SW5) 2, 7, 8, 10, 11 and 13 on each of the LED displays will 
go low. Unless an element is burned out, every digit in 
both displays should be an eight. 







































POWER 
(SW6) 


Single pole single throw switch: When closed, applies 
+ 5.0 V de power to the signal processors and the dis- 
plays. 
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Figure 18. MC68705U3 Pin assignments: From Ref. 10: p. 1. 


Once bit 7 has been set by an interrupt, it must be cleared by software to avoid repeated 
and unwanted interrupts from occurring. This task is performed by the Mode Change 
Routine in each EPROM. [Ref. 10: pp. 1, 10, 13, 15] 
6b. Timer 

The operator can cause either or both of the displays to “blink” by using 
the Display Mode Switches, SW2(P) and SW2(T). When one of the systems has its 
display in the Blinking Mode, the associated MPU uses its timer to generate a timer in- 
terrupt request every second. The interrupt request causes the MPU to execute the 


Mode Change Routine. A block diagram of the timer is shown in Figure 20. The timer 


consists of an eight-bit counter which is decremented toward zero by the /Q,y input. 


When the counter reaches zero, it sets the Timer Interrupt Request Bit (TIR) of the 


Timer Control Register (TCR), and a timer interrupt request is generated unless the 
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Figure 19. N1C68705U3 Memory Configuration: From Ref. 10: p. 5. 


Timer Interrupt Mask Bit (TIM) of the TCR is set. A brief description of cach of the 
timer registers and their configuration follows. 

(1) Timer Data Register (7DR). Whe TDR is the eight-bit counter 
which sets the TIR bit of the TCR when it decrements to zero. 

(2) Timer Control Register. The contents of the 1CR determine the 
general operation of the timer. 


¢ Bit 7, Timer Interrupt Request (TIR), signals a TDR underflow when it is set and 
will cause a timer interrupt request if the TIM bit of the TCR is clear. The TIR 
is cleared by the MPU reset or by program control. 


¢ Bit 6, Timer Interrupt Mask (TIM), inhibits a timer interrupt request when it ts sct. 
It is set by external reset or program control to inhibit the Blinking Mode, and is 
cleared by software when the Blinking Mode is requested by the operator. 


e Bit 5, External or Internal Clock Select (TIN), is used to select the timer clock . 
source. Since the internal clock is used in this application, the TIN bits of both 
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Table 3. MPU CONNECTIONS 


te etaemeecccainese 

2 RESET When RESET is pulled low program execution halts, ali variables are 
reinitialized and the Pan display is set to zero. SW1(P) controls the 
RESET line on the Pan MPU. 



















3 INT Allows asynchronous interruption of the processor. When INT is 
: pulled low by the Count Edge Detector the MPU executes the 
“Count Routine”. 


eae +5 V de power connection. 


Pee eee External clock input. Connected to a 4.0 MHz external clock which 
an ae the MPU svstem clock. 


E XTAL | Crystal clock input. Connected to ground since an external clock is 
used. 


Programming voltage pin. Connected to V., for normal operation. 
PP 
Timer | External timer control input. Connected to V¢¢ since the internal 
timer 1S used. 


| | Port C | General Purpose | O lines. : 


Oe PCO: The two least significant digits in the display are represented in bi- 
nary coded decimal (BCD) by these eight lines. 


pu | PC? 
| 16 | PC7 | 
|_| Port D | General Purpose inputlines. 


PD7 is the Channel A input to the MPL. 
PD6 is used as a second interrupt line. 
When PD6 goes low the MPL changes display modes. 
PDS is the Channel B input into the MPU. 

PD4 is the Function input into the MPU. 

PD3 is the Set input into the MPU. 

PD2-PD0 are not used and are tied to ground. 
































[23 | PDI | 
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Table 4. MPU CONNECTIONS (CONTD.) 


[Pin] Name | Description 
| | Port B General Purpose I/O lines (LED compatible). 


The most significant digit is represented in BCD by PBO-PB3 except 
26 | PBi | on the Tilt MPU where these lines are connected to ground. 


PB4 determines which digits in the display are blanked. 


PBS is not used. Connected to ground. 
PB6 determines the presence or absence of the display minus sign. 


PB7 determines the presence or absence of the display decimal point. 


|__| Port A | General Purpose 1O lines, 
The third and fourth least significant digits are represented in BCD 
by these eight lines. 





















































MPU's are always cleared. For the same reason the Timer pins are connected to 
Vec (see Table 3). 


e Bit 4, External Enable (TEE), is not used by the measurement system. By keeping 
the TEE clear at all times, the 68705’s internal timer is used exclusively. 


e Bit 3, Prescaler Clear (PSC), is not used in this application; always cleared. 
e Bits 2-0, Prescaler Select (PS2, PSI and PSO), are always set during program exe- 
cution. This causes the internal timer signal frequency to be divided by 128. 
(3} Mask Option Register (MOR). Unlike the TDR and TCR the MOR 
is not software programmable; instead, it is implemented in EPROM. 
e Bit 7, the Clock bit, is cleared to allow operation of the external 4.0 MHz clock. 


e The Timer Option bit (TOPT), bit 6, is also cleared in this application. This per- 
mits the TCR to be software programmable. 


¢ Bit 5 is cleared to permit the use of the internal clock with the timer. 


® Bits 4 and 3 are not used. 
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Figure 20. 





e Bits 2-0 are all set and serve the same function as PS2, PS] and PSO bits of the 
TCR. [Ref. 10: pp. 6-8, 13-15] 
3. RAM 
The MC68705U3 has 112 bytes of RAM. The 112 bytes includes 31 bytes that 
can be used for the stack. Use of the stack is quite limited. During interrupts it is used 
to save the contents of the CPU registers and the program counter. During subroutine 
calls only the program counter is saved. The user’s program has no other access to the . 
stack. The programs written for each of the MPU’s require less than 25% of the avail- 
able RAM. The Pan MPU uses 27 of the 112 available bytes and the Tilt MPU uses 
only 22 bytes. The programs listed in Appendix D explain the function and give the 
location in memory for each of the variables. [Ref 10: p. 5] 
4. ROM 
The 3776 bytes of user EPROM in the MC68705U3 are divided into three sep- 
arate blocks in the memory. Page Zero User EPROM is the ROM located between ad- 
dress S080 and SOFF. Because these addresses are only one byte long, instructions 
located in Page Zero ROM can be referenced with addressing modes not permitted with 
instructions located in other parts of the memory. Between address $100 and SF37 is the 
User Main EPROM. This portion of the memory in each MPU contains the vast ma- 
jority of the signal conditioning programs. Located in another portion of the EPROM 
are the Interrupt Vectors. In each of these locations is the address of the first instruction 
the MPL is to execute when a particular interrupt occurs. 
As with the RAM only a fraction of the available EPROM has been used in this 
application. The Pan MPU uses 899 bytes of the 3776 available and the Tilt MPU uses 
only 767 bytes. Since both programs are so small, one could reasonably ask whv the two 
programs were not both put in one MPU. The primary problem with this idea is that 
each microprocessor can perform only one operation at a time. As indicated at the end 
of Chapter II, if the camera servo is rotating about its vertical axis at its maximum ve- 
locity of 1 rpm, the Pan signal conditioner must be capable of counting and displaying 
51,200 counts per minute. Using a 4.0 MHz clock this allows the MPU 1172ys to count 
each pulse. Similarly the Tilt MPU has 1758us to count each pulse when the camera is 
rotating at its maximum velocity about the horizontal axis. Assuming that the camera 
is rotating at its maximum velocity on both axes at the same time, and one MPU is being . 


used to count the pulses from both encoders, the MPU needs to count 75,800 pulses per 


minute, which only allows 781.3 ws per pulse. The Pan MPU currently requires a max- 





imum of 1032 instruction cycles or 1032us to count a single pulse, and the maximum 
execution time for a single pulse on the Tilt axis is 825us. Thus, a single 68705 lacks the 
computational speed required to ensure that no counts would be missed if it was used 
to process the data from both encoders. 

5. Central Processing Unit (CPU) 


The CPU of the M6805 Family is implemented independently from the I/O or 
memory configuration. Consequently it can be treated as an independent central 
processor communicating with 1;O and memory via internal address, data and con- 
trol] buses. [Ref 10: p. 6} 


The CPU has five registers that are available for use by the operator. The 
function of each of these is described below. 


e¢ The Accumulator (A) is a general purpose data register used for arithmetic calcu- 
lation and data manipulation. 


e The Index Register (X) can be used as a second accumulator but is generally used 
for the indexed addressing mode. In the indexed addressing mode an effective ad- 
dress is created by adding the contents of X to a number provided bv the instruc- 
tion. 


¢ The Program Counter (PC) contains the memory address of the next instruction to 
be executed by the MPL. 


¢ The five bits of the Condition Code Register (CCR) keep information concerning 
the results of the last instruction executed by the MPU. Reference 14 gives a de- 
tailed description of each of the instructions in the M6805 Family Instruction Set 
and explains the effect of each instruction on the CCR. A brief description of each 
bit in the CCR follows. 


« The Carry (C) bit is set if a carry or a borrow was generated by the last arith- 
metic instruction. The state of the C bit can be software controlled. 


» The Zero (Z) bit is set if the result of the last arithmetic, logic or data manipu- 
lation instruction was zero. 


» The Negative (N) bit is set if bit seven of the result of the last arithmetic, logic, 
or data manipulation instruction is set. 


« The Half Carry (H) bit is set ifan ADD or an ADC instruction causes a carry 
to occur between bits 3 and 4 of the result. 


« The Interrupt Mask (I) bit is set when an external_interrupt (INT) occurs. If 
another interrupt occurs (e.g. Timer Interrupt or INT2 ) when the I bit is set, 
the second interrupt is latched so that it can be processed as soon as the I bit 
is cleared. The I bit can be set or cleared by software. 





e¢ The contents of the Stack Pointer (SP) are the address of the next available location 
on the stack. As previously discussed, the stack is only used to keep track of the 
PC during subroutine branches, and all of the CPU registers during an interrupt. 
(Refs. 10: p. 6, 14: pp. 14-15] 
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6. Input 

Each MPU uses six input lines. Two of these lines, INT and INT2, are inter- 
rupt lines that detect a negative-going edge on their respective lines. The other four lines 
are genera] purpose input lines on Port D. All of the pins on Port D are TTL compatible 
which made the hardware design relatively straightforward. The electrical character- 
istics for the input pins are listed on p. 2 of Ref. 10. 

The general operation of the two interrupt lines is described in Table 3 on page 
39. Once they are understood, interrupts are a simple yet powerful tool. Only three of 
the four interrupts available on the MC68705U3 are used by the Pan and Tilt programs. 
The software interrupt is not used. When the MPU is interrupted, current program ex- 
ecution is halted, the contents of the CPU registers are placed on the stack, and the 
MPU fetches the contents of the appropriate interrupt vector from memory. After the 
interrupt vector has been fetched, the PC is moved to that address and execution of the 
interrupt routine begins. There is no ambiguity when an external interrupt occurs since 
there is a dedicated interrupt vector in memory. The timer interrupt and INT however 
share the Timer Interrupt Vector. When one of these interrupts occurs, the interrupt 
routine must determine the source of the interrupt by checking the TIR bit of the TCR 
and bit 7 of the MR to determine the source of the interrupt [Ref. 10: p. 11]. Normal 
program execution resumes at the point at which the interrupt occurred when the inter- 
rupt routine executes a return from interrupt (RTJ) instruction. 

The Function and Set lines on pins 20 and 21 are connected to the Function and 
Set switches. The operation of these switches is described in Table 2 on page 36. The 
remaining two input lines to each MPL are Channels A and B from the respective shaft 
encoders. The MPU programs use the information from these two inputs to determine 
the direction of rotation and to identify repeated oscillations about a single transition. 

7. Output 

Each MPU is designed to provide position information at its output in two basic 
forms. On the Pan axis, in the Count Mode a number between -51,200 and + 51,200 
constitutes the output while in the Position Mode the output is an angle between 0° and 
360°. A five digit display with a minus sign is sufficient for the count display. Using a 
five digit display with a decimal point in the Position Mode permits the angle to be dis- 
played to the nearest hundredth of a degree, This resolution is not quite as good as the 
resolution of the shaft encoders (+0.007°); however, final testing of the measurement 


system revealed that resolution is actually limited to about + 0.02° on the Pan axis and 


about + 0.14° on the Tilt axis. The five digit display is therefore completely adequate 
for this svstem. 

The Pan MPU uses 23 of its 24 output pins to represent the five digits, a minus 
sign and a decimal point. Each of the five digits is available in BCD form on four output 
pins of the MPU. The five digits are referred to as Digit 1, Digit 2, etc., with Digit 1 
being the least significant digit and Digit 5 being the most significant digit. Port A has 
as its output the BCD representation of Digit 3 and Digit 4. Digit 1 and Digit 2 are 
represented by the output of Port C. The low four bits of Port B contain the BCD 
representation of Digit 5. These 20 output lines are the input to five 74LS47, 
BCD‘7-Segment Decoder;Drivers, which decode the BCD signals and drive the common 
anode LED indicators. The output from Pin 29, PB4, is one input to a 74LS32 OR gate, 
the output of which is used to blank leading zeros out of the display. Pin 30 is not used 
and is tied to ground. The remaining two output pins drive two LED segments in the 
display. The signal on pin 31 turns the minus sign off and on, and the signal on pin 32 


determines whether the decimal point is displayed. 


The electrical characteristics of the I,O Ports are given on p. 4 of Ref. 10. The 


output characteristics of Ports A, B and C are compatible with the input characteristics 
of the 74LS47 and the 74LS32 given on pp. 4-59 and 4-48 of Ref. 11. The pins on 
Port B are capable of sinking 10 mA when Port B is configured as an output port. A 
220 Q resistor placed in series with each of the display segments limits the current to 
approximately 9 mA and permits the MPU to drive the decimal point and minus sign 
directly. 

One consideration in the design of this system was to provide a system capable 
of being readily expanded to meet changing needs. To this end, in addition to being 
connected to the LED display devices via the 74LS47’s, the BCD data lines are also 
connected to a header on each of the MPU circuit boards. If, at a later date, the posi- 
tion information needs to be used in another system, a jumper connected to each of the 
headers could provide the information with little or no modification. 

The Pan and Tilt signal processing subsystems are virtually identical in the 
hardware used to implement them. The only difference is that the Pan system has a five 
digit display, and the Tilt system needs only four digits to display its position informa- 
tion. Consequently, the Tilt system does not use Digit 5, and pins 25-29 are tied to 


ground. 





F. DISPLAY 

Each digit represented in BCD at the output of the MPU is decoded by a 74LS47 
BCD;7-Segment Decoder;Driver. The decoding devices each convert a four bit BCD 
representation of a number into seven signals that each drive a separate segment of a 
common anode, seven segment, LED display. The 74LS47 is capable of sinking 24 mA 
from each of the LED segments. Without a current limiting resistor between each of the 
Output pins on the 7447 and the corresponding pin on the display element however, this 
maximum current is exceeded. When this happens the LED’s have a very short life, the 
7447 overheats and the system fails to function properly. The addition of a 220 Q re- 
sistor in each branch limits the current to about 9 mA per segment, and permits 
trouble-free operation. 

Three of the output pins on each MPU are not used as inputs to the 7447's. As 
discussed in the previous section, the Decimal and Minus lines each drive individual 
LED segments directly. The third line, also mentioned briefly in the preceding section, 
is used with the Blanking In’ Ribbon Blanking Out (BI, RBO) signal from Digit 4’s 7447 
to determine the Ribbon Blanking In (RBI) signal into the 7447 which drives the display 
for Digit 3. 

The term “blanking” simply means removing the leading zeros from the displav. 
The two display modes available from the MPU’s have different blanking requirements. 
In the Position Mode the three least significant digits are not blanked, while in the 
Count Mode, all but the least significant digit are blanked. The RBI and BI'RBO pins 
on the 7447's, the Blank line out of each MPU and the OR gates, connected as shown 
in the schematics in Appendix A, provide this capability. 

The Light Test (LT) pin on each 7447 is connected to SW5. When the switch is 
closed, the Light Test line goes low and each of the output lines on each of the 7447's 
also goes low, thus sinking current from all of the LED segments simultaneously. This 
feature allows the operator to check for inoperable display segments. 


G. POWER SUPPLIES 

The two power supplies shown in Figure 2 on page 6 are each +5.0 Vdc supplies. 
The power supply which provides power to the shaft encoders and the line drivers is 
physically mounted in the camera housing. It was built by modifying the + 12 Vdc auto 
iris power supply. This was accomplished using an LM7805 Voltage Regulator in the 
manner shown in Figure 8 of Appendix A. The auto iris requires only 100 mA at 


+12 Vdc for correct operation, and the LM7812 Voltage Regulator has an available 





output current of 1.0 A [Refs. 15, 16]. The remaining 900 mA is available to the 
LM7805 to power the encoders and the line drivers. Reference 9 lists the maximum 
power requirement for the IIEDS-600 as 40 mA at +5 Vdc, and Ref. 11 specifies the 
maximum power requirement for a 74S140 is 1 mA at +5 Vdc. Thus, the 84 mA re- 
quirement for the two encoders and four line drivers is well within the capabilities of the 
modified power supply. 

The second power supply is capable of providing 6.0 A at +5 Vdc which is more 
than adequate to provide the 1.4 A needed by the signal processors and the display de- 
vices. The power supply also has 12 Vdc and -5 Vdc ports. To preclude the potentially 
disastrous results which might occur if the power supply were incorrectly connected to 
the signal processor/display devices, the circuitry shown in Figure 21 was included on 
each MPU and display printed circuit board. 


1.0A 
Pico-fuse 


Sed 
IN 3826 
Zener diode 


== 
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Figure 21.  Reverse/Over-voltage Protection Circuit 





IV. CALIBRATION , TESTING AND IMPLEMENTATION 


A. GENERAL 

Once the basic system design had been completed, and the MPU programs had been 
written, a prototype system was constructed. The prototype system might also be called 
the development model, since it was not only used to test the design , but was also used 
to calibrate the MPL programs. A block diagram of the prototype system is shown in 
Figure 22. The M68705EVM Evaluation Module (subsequently referred to as the 
EVM) provided the capability to debug and evaluate the MC68705U3-based signal 
processing subsystem. Operation of the signal processing MPU was performed by an 
MC68705U3 resident on the EVM. 

The prototype system provided considerable flexibility in the testing and calibration 
of the system. The assembly language programs for the MPU’s were written and edited 
on the PC. They were then assembled and linked using the 2500 A.D. 6805 Cross As- 
sembler and 2500 A.D. Linker [Ref. 17: pp. (1-1)-(2-38)]. The result, a Motorola $19 
output file (see [Ref. 17: pp. (A-1)-(A-4)]), was then down-loaded to the EVM using the 
file transfer program, Kermit. Downloading procedures are detailed in [Ref. 18: pp. 
(3-10)-(3-25),(3-37)]. The PC-EVM interface is shown in Figure 23. 

After the program had been down-loaded into the MC68705U3 resident on the 
EVM, data entry and program debugging were controlled via the CRT monitor key- 
board. The CRT-EVM interconnection is shown in Figure 24 and the monitor com- 
mands are described in [Ref. 18: pp. (3-8)-(3-25)]. 

The remainder of the signal processing functions were realized using hardware ex- 
ternal to the EVM. These functions included edge detection of the output signals from 
the shaft encoders, decoding the output of the MPL, and generating the signals to drive 
the display devices. This portion of the prototype, referred to by {Ref. 18] as the “target 
system”, was built on breadboards and is represented by the block in the center of 
Figure 22. The target system was connected to the MCU via a 40-pin jumper header, 
Ji, on the EVM. The pinout for J] is shown in Figure 25. The labels in Figure 25 refer 
to the labels used in the schematic diagrams which are shown in Appendix A. 


B. CALIBRATION 
Once the MPU programs were capable of counting the pulses generated by the shaft 
encoders, the programs needed to be “calibrated”. This calibration procedure required 
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determining the angular distance through which the camera rotated between successive 


pulses from the shaft encoder. This number is a scale factor, which, when multiplied by 
the total number of pulses from the shaft encoder, yields a number equal to the angular 
displacement of the camera. The calibration procedure also involved determining the 
amount of hysteresis present in each of the gear trains. 

1. Scale Factor 


To determine the scale factor (SF) the simple geometric relationship 


cil opposite 
oan ( adjacent ) (12) 


was used. Using a small laser attached to the camera servo, and the geometry shown in 
Figure 26, the SF could be experimentally determined. As the camera servo was rotated 
through an angle, 6, the MPU was used to count the output pulses from the shaft en- 
coder. The laser beam was projected on a vertical surface at a distance, a, away from 
the axis of rotation. The beam of the laser spread to a diameter of approximately 0.4 
in. over a distance of 30 ft. A template with a 0.4 in. diameter aperture was used to mark 
the location of the “spots” on the distant wall. The distance between the spots, /, was 
measured by selecting one edge of one of the marks and measuring the distance to the 
corresponding edge of the distant mark. Then, having determined / and @ and reading 


the count, C, from the display, the SF could then be determined from 


( eget ees, Pulse) ee 
l . 








Using Equation (13) to simplify the expression, 


a(sF) = SP a a (14) 


yields 
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which indicates that C, a and / should all be as large as possible to minimize the error 


d(SF) =— = 


d(SF) = 


in SF due to a measurement error in a or |. The physical size of the laboratory limited 


the distance, a, to 30 ft. When a = 30 ft, / was limited to about 3.5 ft in the horizontal 
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plane and about 4.0 ft in the vertical plane. By modifying the geometry as shown in 
Figure 27, the count, which from Equation (13) is directly proportional to @, could also 
be maximized. The configuration shown in Figure 27 was used to obtain the scale fac- 
tor calibration data for the Pan axis. However, since the servo is incapable of rotating 
360° about the Tilt axis, the test configuration shown in Figure 26 had to be used the 


collect the data for that axis. 


# -1 ’ 
6 =360 -tan ok 





Figure 27. Alternate Geometry Used to Determine the Scale Factor 


Adopting the notation, X, to represent the mean value of a random variable, 


X; if X is discrete with N measured values, 


Lvy 
Kets, (16) 
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where X, is the ith measured value of X, and the approximation becomes better as N 


approaches infinity. 
Using the expression in Equation (16) and the measured data for the scale fac- 
tors, from 3] measurements on the Pan axis, 


SF pan = (7.0312 x 107*)°Pulse™' , (17) 
and after 32 measurements on the Tilt axis, 
SFr, = (7.0452 x 107°)*Pulse™' , (18) 


where the subscripts indicate the axis. The actual implementation of these scale factors 
is described later in this chapter and in the documentation for each of the MPU pro- 
grams. 

If the error in the ith measurement is described by 


e, = X,—X ’ (19) 


then the root mean square (RMS) error in N measurements of X is given by; 


eerie 
aie |e » 8} , (20) 
ix] 


Note that this is also the definition of the standard deviation of X. 
The RMS errors in the Pan and Tilt scale factor measurements were determined 
from Equation (20) and the measured data to be; 


Osp,,, = (4.62 x 10°°)*Pulse™! (21) 
Osp,,, = (6.89 x 107°)°Pulse™' . (22) 


As before, the subscripts are used to identify the axis and the source of the error. The 
fact that the errors are small compared to the mean values suggests that the means 
should closely approximate the actual values for the scale factors. 

2. Hysteresis 


Houghton defines backlash in wormgearing as “...the total play between the 
surfaces of the worm and worm wheel teeth measured normal to the faces.” [Ref. 19: 


pp. 1.4, 1.5] Backlash only poses a problem in the measurement system when the servo’s 
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direction of rotation changes. Figure 28 is a typical hysteresis curve. As long as the 
direction of rotation of the worm is increasing the @worm/Oworucear relationship is linear. 
However, when the direction of rotation reverses there is a region, depicted by the left 
pointing arrows, where the position of the worm changes without a corresponding 
change in the position of the wormgear. Note that once all of the backlash has been 
taken up the O@yoru/Oworucear relationship is again linear until the direction of rotation 


changes. 


By ORMGEAR 


8 HYST | 





Figure 28. Typical Hysteresis Curve 


The purpose of the hysteresis buffer in the MPU is to permit the signal 
processor to account for the backlash error introduced into the measurement by the 
worm-wormgear connection. The theory of operation for the buffer is relatively straight 
forward and is best described by the flow diagram in Figure 29. The buffer is a data 
byte in the MPU RAM. As long as the buffer is full, i.e., the contents are equal to the 
predetermined buffer length, a clockwise (CW) signal from the shaft encoder (increasing 
elevation and increasing azimuth are defined as CW rotation for the purposes of this 


system) causes the position counter to be incremented. Similarly, counter-clockwise 
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Figure 29. Operation of the Hysteresis Buffer 
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Figure 30. Hysteresis Curve 


(CCW) signals cause the position counter to be decremented if the hysteresis buffer is 
empty. i.e., the contents are equal to zero. These two situations correspond to the two 
linear sections in Figure 28. From Equation (13), the horizontal separation of these two 
lines is related to the length of the hysteresis buffer, C, by the expression 


AG, 


CH =5F 


(23) 


Similarly, using the SF to map @yogy into C, and the fact that the displacement of the 


wormgear equals the displacement of the axis of interest, the curve shown in Figure 30 
can be obtained from Figure 28. From Figure 30 it is apparent that two different pulse 
counts can be obtained for any given position, 6, depending on whether that position is 
approached from a CW or a CCW direction. The difference in the two counts is a 
measure of the hysteresis present in the gear train and is also the required length for the 
hysteresis buffer. By using this difference as the length of the hysteresis buffer, counts 
received by the MPU which occur while the gears are operating on one of the horizontal 
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sections of the curve in Figure 30 are not considered “valid” and therefore do not cause 
the MPL to modif¥ the position. Using Equation (23) and data collected in the labo- 
ratory the average hysteresis present in each of the gear trains was determined (from 45 
measurements on the Pan axis and 30 measurements on the Tilt axis) to be 


Cyipan) = 7:39 Pulses (24) 
Cutin = 6.06 Pulses (25) 


and the RMS errors were calculated to be, 


= ].0 Pulses (26) 


Copan) 


C= 0.91 Pulses . (27) 


C. IMPLEMENTATION OF THE CALIBRATION DATA 
1. Background 

Figure 31 outlines the basic operation of each of the MPU’s. Although each 
of the routines is described in detail by the comments included in the programs, the op- 
eration of the Count Routine is the heart of the program and should be explained prior 
to discussing the actual implementation of the experimental results. 

When the system operator causes the camera servo to rotate, each optical shaft 
encoder translates the displacement of one of the axes into two series of digital pulses. 
The two pulse trains, referred to as Channels A and B, are TTL logic level signals. When 
the logic level of Channel A transitions from low to high (rising edge transition) or from 
high to low (falling edge transition), the edge detector (See Figure 15 on page 33) pulls 
pin 3 of the associated MPU low for approximately 2 wsec. When this occurs an ex- 
ternal interrupt (EXT INT or INT ) request is generated and the MPU begins execution 
of the Count Routine. 

As menuoned in Chapter III, since both rising and falling edge transitions are 
detected by the edge detector, the signal processor must be capable of detecting multiple 
oscillations of the shaft about a single logic level transition point. Accordingly, the first 
tasks performed by the Count Routine are to determine the direction of rotation and to 
simultaneously determine whether the interrupt is the result of a stationary shaft oscil- 
lation. To do this the Count Routine checks the state of pin 17 (Channel A) and pin 
19 (Channel B). Operation of this portion of the routine is summarized in Table S. 
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Figure 31. 


INITIALIZATION 
ROUTINE 


HYSTERESIS 
MODIFICATION 
ROUTINE 





Program Flow Diagram: Program executes in the Wait Loop until; (a) 
the operator requests to modify the hysteresis buffer, (b) the operator 
requests to change the display mode, (c) an external interrupt is gener- 
ated by the Channel A edge detector or, (d) a timer interrupt causes the 
display mode to “blink”. All interrupt routines are terminated with a 


return from interrupt (RTI) command. 
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Note that CW rotation is indicated when Channel B leads Channel A in phase and CCW 
rotation is indicated if Channel A is leading Channel B. The possibility of erroneously 
counting multiple oscillations about a single point is eliminated by “counting” only the 
leading edge transitions when the shaft is rotating CW and only the trailing edge tran- 
sitions when the rotation is CCW. All other transitions cause the program to execute 
a “return from interrupt” (RTI) instruction. 
2. Implementing the Hysteresis Buffer 
The transitions that are to be counted cause the program to compare the con- 
tents of the hysteresis buffer, HYSTCT, and the direction of rotation to the exper- 
imentally determined buffer length, HYST~C,, . If the rotation is CW and the buffer is 
full (i.e, HYSTCT=HYST), or if the rotation is CCW and the buffer is emptv (i.e., 
HYSTCT=0), then the “slack” due to the gear backlash should have been taken up , 
the transitions are considered “valid” and the MPU modifies the position appropriately. 
“Invalid” counts cause the contents of the hysteresis buffer to be incremented or decre- 
mented depending on whether the present direction of rotation is CW or CCW 


(Figure 29 refers). 


Table 5. COUNT ROUTINE LOGIC 


Direction Count the : 


High ee 


From the calibration data for the Pan axis, Crea 7-4 and OCripamye 1-0: Because 
the length of the hysteresis buffer must be an integer value, C23 needed to be rounded 
off. Rounding to the nearest whole number initially seemed the most logical approach. 
Upon further consideration, however, it was decided to round 7.4 up to 8. Considering 
the relatively small data base (45 measurements) upon which the average was based, the 


fact that the standard deviation was 1.0 and that the gear backlash will only increase 
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with time, this seemed like the most reasonable approach. The buffer length for the Tilt 
axis Was set equal to 6 (Conn = 6.06) . 
3. Implementing the Scale Factor 

There are three counters in each MPU that keep track of the position informa- 
tion for the axis of interest. The first, BINCT, is simply a binary counter that is incre- 
mented by one for each valid CW count and decremented by one for each valid CCW 
count. The other two counters consist of two sets of pointers, two sets of data registers 
and a shared data table. Each byte in a pointer points to an address in the table that 
contains two BCD digits which make up a portion of the position information. 

In order to increment (decrement) the pulse count, BCDCT, by one, the count 
pointer, CTPTR, is incremented (decremented) by one causing it to point to a new table 
address. The contents of the table at the new addresses are then moved into BCDCT. 
Modification of the position counter, DEGRES, is performed in much the same manner. 
DEGRES contains a BCD number that, when multiplied by 0.001, represents the angu- 
lar position (in degrees) of the shaft of interest. Thus, each time the camera is displaced 
in a CW direction through one degree, the contents of DEGRES should be incremented 
by 1000. To do this. the position pointer, PTR, must be incremented (decremented) by 
seven or eight each time CTPTR is incremented (decremented) by one. Incrementing 
PTR bv seven corresponds to an angular displacement of 0.007° and since 
SF pan and SF;,, are each slightly larger than 0.007°, periodically PTR must be incre- 
mented by eight to reduce the cumulative round off error. Specifically, if PTR is incre- 
mented by seven each time a valid CW pulse is detected (except when BINCT is an even 
multiple of 32) and is incremented by eight when BINCT is a modulo 32 number, the 


effective scale factor is given by; 


] 
SF ey, = 37 (31(0.007) + 0.008) 


(28) 
= 0.00703125°Pulse™! , 


which is slightly larger than the desired 0.0070312°Pulse-', for the Pan axis and slightly 
smaller than the desired 0.0070452°Pulse-! for the Tilt axis. To further reduce the cu- 


mulative round off on the Pan axis, every 16,384 (2'* = 32 x 512) counts PTR is incre- 


mented by seven instead of eight. This results in an effective scale factor of, 





1 1 4 
SFe,= 54 {sul yy Gun +8) 10 ]+ 2007} 


= (7.03119 x 107°)°Pulse™? , 


which is within two parts in one million. 
The maximum error introduced into the measurement should occur when the 
camera is rotated through the largest possible angle. To predict this error on the Pan 


axis, when the camera has been displaced by 360°, 


BCDCT = 280 
SE 


Pan 


= 51,200 Pulses 
so the position error using SF,,, and SF.y, should be; 


€pan = 360° — [3(SF gy.) + (51,200 — 3(16,384))(Soy )] 


3] 
= 0.00295° . (G1) 


Thus, the error due to the scale factor on the Pan axis should be well within the desired 
resolution of + 0.006° . 

Using SF iy, alone as the scale factor for the Tilt axis, the maximum theoretical 
error over +12° due to the scale factor round off is determined in the same manner. 
2° 
BCDCT = == 


Tit 
= 17,033 Pulses 


So that, 


CTin = 12°- 17,033(SF gy) 


33 
= 0.0234° , ea 


which again is significantly less than the required resolution of +0.23° for the Tilt axis. 

The final step in the Count Routine is a branch to the Display Routine. De- 
pending on whether the MPL is in the Count or Position Mode, the Display Routine 
copies the contents of BCDCT or DEGRES to the output ports and then executes an 


RTI instruction. 





D. FINAL TESTING 
1. General 

Final laboratory testing and evaluation of the measurement system was per- 
formed after the calibration results had been implemented in each of the MPU Count 
Routines. The purpose of the testing was to verify that the calibration results had been 
properly coded into the MPU’s and to determine the resolution capabilities of the 
measurement system experimentally. 

This verification process included determining the combined error due to the 
hysteresis and scale factor errors. The use of some simple multiple random variable 
theory was therefore required. From [Ref. 20: pp. 121,122] the variance of a weighted 
sum of M random variables is the weighted sum of their covariances, C, 4, and is given 
by, 

MoM 
=>) Cry , (34) 


i=} j=l 


where a, is the weight associated with X, Additionally, the covariance can be expressed 


as 
Cxy = poxey , (35) 


where p is the normalized second-order moment and is known as the correlation coeffi- 
cient of X and Y. The correlation coefficient is bounded by 


-lspsil. (36) 


In the case where there are two equally weighted random variables, M=2 and 
a, =o,=1.0. Substituting into Equation (34) and expanding 


o° = Cyy + Cxy + Cyy + Cyy « (37) 
Using Equation (35), 
o= ox + 2pcxoy + oy . (38) 
Combining (36) and (38) vields 


a. — 20,0, + oy <0’ <ox+ 2ox0y + oy : (39) 
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The bounds of the combined scale factor and hysteresis errors can therefore be deter- 
mined from 


rs 2 2 2 
Vi Gece — 20 65.Fe, + Fey S Fe Srl Sey + 204,.0,, + Oe, - (40) 


where: 
® o,= standard deviation of the combined error, 
© o,,, = Standard deviation of the scale factor error, and 
¢ o,, = standard deviation of the hysteresis error. 


Note that the bounds are determined by the two cases where the hysteresis error, ¢,, and 
the scale factor error, e.;, are “completely correlated”. The upper bound corresponds 
to the case where an increase in e,,; implies an increase in e,, and the lower bound cor- 
responds to the case where an increase in esp directly implies a decrease in ey. 

A third case is also of particular interest. If e, and es; are completely uncor- 
related, i.e., o = 0, then from Equation (38), 


Gee + Oey (41) 


Oe = N 
which can also be written as 
(2 2 
e=+ / Gr +éey , (42) 


where e = +, is the 1.0 o error due to the scale factor and hysteresis errors, e,- and e,, 
respectively. Based on the physical nature of the two errors it is reasonable to assume 
that e,, and e,, are statistically uncorrelated; however, no experimental data was collected 
to support this hypothesis. Due to this lack of a priori information, the maximum RMS 
error, €,,., = + %,,. given by 


OT 


v2) 2 
Cmax = ty se + 2espeH + ey , (43) 


will be used to describe the resolution capabilities of the measurement system. 
2. Pan Axis 
a. Hysteresis 
To test the operation of the Pan axis hysteresis buffer, the Initialization 
Routine was programmed to set the buffer length to 8. Then, as described in the first 
section of this chapter, the servo was used to position the beam of a small laser on a 
fixed target. By approaching the target alternately from a CW and a CCW direction and 
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comparing the difference in the output counts from the shaft encoders, the hysteresi: 
error was determined. The average error after 3] measurements was 


€H(Pan) = —0.1880 Pulses , (44) 


and the RMS error was 


o = 1.7699 Pulses . (45) 


CH(Pan) 


Since the mean error is “near zero” compared to the standard deviation, the 1.0 o error 
€,, due to the hysteresis can be determined from 


Cy = + (o,,,) SF (46) 


so that 


€H(Pan) =+ 0.0124° . (47) 


b. Scale Factor 

Verification of the scale factor was performed in the same manner as the 
scale factor calibration, except that the MPU was calibrated in the Count Mode and 
tested in the Position Mode. Since these tests sought to find the maximum error due to 
the scale factor, and the error is directly proportional to the angle that is being meas- 
ured, these tests were conducted by displacing the camera servo through the maximum 
angles permitted by the camera and the laboratory. Specifically, on the Pan axis the 
servo Was rotated through approximately 360°. The mean error due to the scale factor 
on the Pan axis was determined from 15 samples to be 


sr (pan) a —0.0018° (48) 


and the RMS error was 


= 0.00890° . (49) 


ese. Pan) 


As with the hysteresis error, if we neglect the small bias due to the €cra,) , We can de- 
scribe the 1.0 o RMS error due to the scale factor as 


€sF(Pan) = £ FsF(Pan) 
= + 0.00890° ° 





c. Combined Error 
From Equation (42) the combined error on the Pan axis if e, and es. are 
uncorrelated can be estimated as 


€pan = + </ (0.0124) + (0.0089) 
= + 0.01526° . 


(51) 


And from Equation (43) the maximum combined error on the Pan axis is 


€pan,,, = + v/ (0.0124)" + 2(0.0124)(0.0089) + (0.0089) 


pan, = +0.0213° . 


The combined error is approximately three times larger than the design specification 
limit and is due primarily to the hysteresis error. 
3. Tilt Axis 
a. Hysteresis 
The procedure used to verify the operation of the calibrated Tilt MPU was 
identical to that described in the previous section. Using a hysteresis buffer length of 6 
resulted in 


Cucriny = —0.0965 Pulses (54) 


= 1.3156 Pulses 


Fenty 
after 13 samples. As before we can define the 1.0 ¢ error from e = oSF to be 


en, = £0.00529° . (56) 


5. Scale Factor 
Testing the scale factor on the Tilt axis was limited by the physical con- 
struction of the servo and the size of the laboratory. The angle over which testing could 
be performed was limited to + 6° from the horizontal plane. Consequently, the RMS 
error for the scale factor on the Tilt axis was determined in exactly the same manner as 





the RMS error for the Pan axis scale factor, but since the error due to rounding of the 
scale factor is directly proportional to the angle being measured the results were multi- 
plied by 2.0 to account for the limited range of the test. The modified results should 
therefore be representative of the maximum error one should expect if the measurement 
system is used to measure elevation angles over a range of + 12°. 


The error due to the scale factor is described from 16 samples by 


CsEcriny = 0.0070° 


= 0.0665° . 


ese ctiny 
Including the factor of two in the calculation we have 


€sF (Tilt) =+ 2(0.0665°) 
=+0.1330° . 


c. Combined Error 
The combined RMS error is determined in the same manner as before. If 


€, and es, are uncorrelated, 


ern = + x! (0.1330)? + (0.00529)? 
SO1931", 


and the maximum combined RMS error is 


Net aa eee 
erin, = + v' (0.1330)? + 2(0.1330)(0.00529) + (0.00529)? 


CT ittnax = + 0.1383° . 


The Tilt axis measurement system appears to perform well within the required resolution 


specifications. 





E. FINAL IMPLEMENTATION 
Once the program debugging, calibration and testing were completed, final imple- 
mentation of the system remained. Taking the design from the prototype'development 


model to a fully functional system was a straightforward but time-consuming evolution. 
The plans for the printed circuit boards (PCB’s) were made directly from the sche- 
matics shown in Appendix A; the boards were then etched and assembled from the plans 
which are shown in Appendix B. All of this work was performed by sailors attached to 
the Academic Division of the NPS. 
As previously discussed, the M6870SEVM Evaluation Module provided a powerful 
and flexible means of debugging and evaluating the performance of the microprocessor 


based signal conditioner. Additionally, once program testing was completed the EVM’s 
EPROM microprocessor programmer provided the means to program the EPROM 
MCU’s. A detailed, but simple to follow, programming procedure for programming the 
MC68705U3 is given in [Ref. 18: pp. (3-26)-(3-27)]. 





Vv. CONCLUSIONS AND RECOMMENDATIONS 


A. SYSTEM PERFORMANCE 
The prototype system was calibrated and successfully tested in a laboratory environ- 
ment. Experimental results indicate that the system is capable of measuring the video 
camera’s elevation over a range of +12° with a resolution of +0.138° and its azimuth 
over 360° with a resolution of +0.021°. The system was designed to be low cost, reliable, 
and easy to operate. Only time will tell whether these objectives were truly achieved. 
The portion of the system that will be located outdoors has been weatherproofed 
and is ready to be placed in service. Printed circuit board plans for the remainder of the 
system have been developed, but final implementation of the system is still ongoing. 
Once the system is fully operation additional testing should be performed in order to 
verify the completed system’s performance. Although the laboratory results indicate 
that the svstem is capable of meeting all of the design criteria except for the required 
resolution on the Pan axis, the system must be further tested in a non-laboratorv envi- 
ronment. “...The proof of a good design rests in the ability of the system to function in 
the outside world.” [Ref 21] 


B. RECOMMENDATIONS FOR FURTHER WORK 
There are several areas for follow-on work with this project. Some possibilities are: 


¢ Incorporate the measurement svstem’s output into the video image being created 
by the video camera. This would permit a permanent record of the position infor- 
mation to be stored with the video image and would facilitate identification of the 
image at a later date. 


e Design and build an automatic feedback control system for the camera. 


e Implementation of a second video camera at the NPS, together with the NPS 
modified IRSTD, would permit triangulation of a target and would consequently 
provide range information which is not currently available. This information could 
provide valuable additional information to those who are developing the signal 
processing algorithms. 
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APPENDIX A. SCHEMATIC DIAGRAMS 
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APPENDIX B. PRINTED CIRCUIT BOARD PLANS 


| e GND | 
| : evocvcce a eee | 
eege 
rts: uw? | 
| Rececee a 
| eoveo ee gee v2 @ B | 
@eoeoeoo TILT 
| Booceoce B® a | 
| 8 vucc | 
a eve seen eee eee 





Line Driver, (a) Front and (b) Back. Full scale. 


80 











1 ee 








emer eee eee ee 


e000 @eoc00e ecoo* eooe 
eeece3e eecoee ececoeo eceece 
td ec ee ea hd SANIW 





1 ed VWwWID3d eq had $a@ SAWNIW 
ecoce eo0eco eoooo ©0000 ec0coe 
ecce eoce ecce cooc5e ooco3e 


Display, Front. Full scale. 











APPENDIX C. MICROPROCESSOR PROGRAMS 


A. GENERAL 

Sections B and C of this Appendix are the listing files for the two MPU programs 
written for the signal processor subsystems. The theory of operation of the two pro- 
grams is identical and is most clearly described by Figure 31. The detailed operation 
of the Initialization , Mode Change, Blink, Output Display and Hysteresis Modify rou- 
tines is described by the comments which accompany each of the programs. In addition 
to the detailed description provided by the program comments, the operation of the 
Count Routine is also explained in Chapter IV. 





B. PAN 


TTL POSITION DETERMINING PROGRAM (AZIMUTH) 
. LATEST REVISION 9 MAY 89 
* FILE MAME PAN .ASM 


te 
** PROGRAM DESCRIPTION 
en 
oe 
ae 


** 1/0 REGISTER ADDRESSES 


oe 
9000 PORTA EQU $0000 1/0 PORT A 
0001 PorTB EQU $0001 1/0 PORT B 
0002 PorTc €EQU $0002. (1/0 PORT C 
0003 PORTD Eau $0003 INPUT PORT D 


oe 
*® DATA DIRECTION REGISTER OFFSET 


en 


0004 pr «= EU (iti (eg. DOR FOR PORT A 1S PORTA+ODR ) 
ee 
© OTHERS 
ae 
0008 TIMER EQU $0008 EIGHT BIT TIMER REGISTER. 
0009 TCR  EQU = $0009 TIMER CONTROL REGISTER. 
OO0A mR EQU = SOQDA = MISCELLANEOUS REGISTER. 
0010 RAM  - EQU.-«=— ss $0010 «= START OF ON-CHIP RAM(112 - 31 FOR STACK) 
0080 ZROM = EQU. «= $0080 = PAGE ZERO OF ROM. 
0100 ROM = EQU. Ss $0100 «START OF MAIN ROM. 
OF38 WOR EQU «ss SOF38—- MASK OPTION REGISTER. 
OFFS INTRPT EQU = SOFF8 LOCATION OF INTERRUPT VECTORS. 
1000 MEMSIZ EQU $1000 MEMORY ADDRESS SIZE. 
een 
** EQUATES 
ae 
0001 Th a 
0002 Bit) Eu 2 
0004 git2 eu 4 
0008 Bits) EU 8 
0010 BiITs EQ 16 
0020 BITS EQU = 32 
0040 8116 = EU 
0080 BIT? EQU 128 
ne 
0000 Bo eu 80 O 
0001 81 Eu 31 
0002 82 Eu 8 2 
0003 83 Eu 3 
0004 B4 eu 4 
0005 BS a) 
0006 B6 Eu 6 
0007 87 fu 7 


ee 

** EQUATES FOR THE TIMER CONTROL REGISTER 
at 

een 


ARVUVAUVUBNNUR RRR RRR RRR 
SS STEEN SS SSE RES HASSE ERLEENSE SSRN ERPARNVE SSSR SERASceanaueune 


0007 TIR Eou 7 TIMER INTERRUPT REQUEST. 1 = REQUEST, 0 = NO REQ. 
0006 TIM fou 6 TIMER INTERRUPT MASK. 1 = DISABLED, O = ENABLED. 
0005 TIN EQu 5 EXTERNAL OR INTERNAL CLOCK SOURCE. 1 = EXT, 0 = INT. 
0004 TEE Eou 4 EXTERNAL CLOCK ENABLE. NOT USED. 

0003 PSC Eou 3 PRESCALER CLEAR. WOT USED. 

0002 PSs2 Equ 2 (PS2) -- 

0001 Pst EQu 1 (P$1) ]-- PRESCALER SELECT BITS. 
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SSSSLLFLAVLSSRLKAKSVAVAAAHAANAAYASSSSSKSL 


102 


—_ at 
FS 


105 
106 
107 
108 
109 
110 
111 
112 
113 
114 
115 
116 
117 
118 
119 
120 
121 
122 
123 
126 
125 
126 
127 


g 


SERS88 


0007 
0006 


0004 


0007 
0006 


0004 





Pso EQU 
on 


0 (PSO) -- 


*® EQUATES FOR THE STATUS BYTE, ‘STAT’. 


oe 
weak 

a 

UD Eau 7 COUNT DIRECTION? 1 = UP, 0 = DOW. 

moD_32 EQU 6 1S ‘BINCT’ MODULO 327 1 = YES, 0 = NO. 

FLASH EQU 5 BLINK THE DISPLAY? 1 = YES, 0 = NO. 

POSCT EQU 4 DISPLAY POSITION OR COUNT? 1 = POS, 0 = COUNT. 
L_SET EQU 3 VALUE OF ‘MODE,PORTD’ LAST TIME. 

WEGTIV EQU 2 IS ‘BCDCT/NEGATIVE NUMBER? 1 = YES, 0 = NO. 

owe 1 WOT USED. 

owe 0 NOT USED. 

wee 

wre 

** 1/0 EQUATES AND DESCRIPTIONS. 

eee 

sites 

aoe PORT A (1/0) 

een 

eee Hoccccce Hocceeee Pan eecee Poccccee Hoccccce toccccee He cewcee He ccecee + 
oss | BCD DIGIT #4 | BCD DIGIT #3 | 
wae Poceeaee Pocceeee So ewceee br eeenee Poewecee Hee nccee Por eceee Hom ecece + 
er | let] CO | CTC] TCO 
ten Hoescece Hoccecee Goocccce occccee Hocccces Hocecces He ecncee Heoccece + 
wee BIT 7 6 5 4 3 2 1 0 
ween 

tee 

wee PORT B (1/0) 

eae 

wen Honnecee do eneen- Hoecenee So ceeene Ho eccene Pececwee Hoeweeee Hecereee + 
wae | DISPLAY CONTROL - [sco DIGIT #5 (MOST SIGNIFICANT) | 
een He ccecee temsecee tecccese Heeeceee Hoceceee Hocccenn Hecceene Heccccee + 
ene | DECPT | POSTIV| | BLANK | 05 | cs | B5 | as | 
eee Pore eee nde cwenne $eeeee Ogee mew wn gece nnee poecccee Hreccene Ho ccccee + 
*** BIT 7 6 5 4 3 2 1 0 
wen 

DECPT EQU 7 TO DISPLAY THE DECIMAL POINT...DECPT IS CLEARED 
POSTIV EQU 6 USED TO DISPLAY NEGATIVE SIGN...CLEARED TO SHOW 
one MINUS SIGN. 

BLANK EQU 4 TO BLANK DIGITS 2 ANO 3...CLEAR BLANK. 

eae DIGITS 4 AND 5 ARE ALWAYS BLANKED. 

eee DIGIT 1 1S NEVER BLANKED. 

een 

“es PORT C (1/0) 

aan 

rte Hoccecee toeccees Hoccence Hrccewes Po eeecen ee Hrccenee Heoecneee + 
aes | BCD oe #2 Jeco ae wIClenst SIGUITICANT) | 
ren Poccccce Pec www wma wwe cece hoe cece etaw ence cna secccchesccscogncceue rd 
ee =| pz | cz | ee | ay bY | cry ef at { 
ane Pore ncee Hececees teccccee Heorerce toccceee torccnee Sorcecnce tercccee + 
*e* BIT 7 6 5 4 3 2 1 0 
fee 

eee 

oes PORT D (INPUT ONLY) 

eee 

eee Poccccee oscceee Poecccee torcccce How cccee Hoecceee ST tocceee + 
see | CHA | INT2 ! CH_B | FUNCT | set | | | | 
ane Pec ceeee oem wenn hewccene Hoe wc e we gewewcce tocereee oer ecee doccrcee + 
eee BIT 7 6 5 4 3 2 1 0 

wee a 

CH_LA EQu 7 INOICATES THE STATUS OF CHANNEL A. 

INT2 Eau 6 INTERRUPT #2. USED TO CHANGE DISPLAY MODES. 

CH_B EQu 5 INDICATES THE STATUS OF CHANNEL B. 

FUNCT EQu 4 USED TO PUT THE PROGRAM IN A MODE THAT WILL ALLOW 
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128 
129 
130 
131 
132 
133 
134 
135 
136 
137 
138 
139 
140 
141 
142 
143 
144 
145 
146 
147 
148 
149 
150 
151 
152 
153 
154 
155 
156 
157 
158 
159 
160 
161 
162 
163 
164 
165 
166 
167 
168 
169 
170 
171 
172 
173 
176 
175 
176 
177 
178 
179 
180 
181 
182 
183 
184 
185 
186 
187 
188 
189 
190 
191 
192 
193 


0010 


0010 


0013 


0017 


OO1A 


OO1E 


0021 


0010 
0011 
0012 


0013 
0014 
0015 
0016 


0017 
0018 
0019 


OO1A 
0018 
o01c 
001D 


OO1E 
OO1F 
0020 


we ‘HYST’ TO BE INCREMENTED. 
SET EQ 3 INCREMENTS ‘HYST’ WHEN TOGGLED AND FUNCT 1S LOW. 
ene 
ren 
SRASSRERSSSAESEREAERAEAAAAAEAERARAAAAAE EAA AA EAA ARE CE EEEEEEEEAORAHEEEEER 
we * 
** RAM VARIABLES * 
ee * 
SERS SAASSSAASASSAAARERATE AA AAAAANA ARAN AA AERA AER EAA A ER AAAEEARAAEAREE 
ot 
* RESERVE MEMORY SPACE FOR THE PROGRAM VARIABLES. 
we 

DATA 
een 
ee 

ABSOLUTE (ABSOLUTE ADORESSING USED WERE TO RELATIVE DIRECTIVE) 
oe 

ORG RAM START OF RAM. 
ee 


*#* BINARY COUNT. 

BINCT RMB 3 

HIBIN EQU BINCT HI BYTE. 
MIDBIN EQU BINCT+1 MIDOLE BYTE. 
LOBIN EQU BINCT+2 LO BYTE. 

ee 


*** POSITION POINTERS. 


PTR = RMB EACH BYTE POINTS TO A POSITION IN THE 
** TABLE THAT CONTAINS ONE OR TWO DIGITS 
** OF THE BCD POSITION. 

PTRG = EQU PTR MOST SIGNIFICANT DIGITS. 

PTR3  EQU pTR+1 

PTR2 —- EQU pTRe2 

PTR1 QU PTR¢3 LEAST SIGNIFICANT DIGIT. 

en 

*** COUNT POINTERS. 

cTPTR RMB 3 EACH BYTE POINTS TO A POSITION IN THE 
*. TABLE THAT CONTAINS TWO OF THE DIGITS 
we IN THE BCD COUNT. 


CTPTR3 EQU CTPTR MOST SIGNIFICANT DIGITS. 
CTPTR2 EQU —CTPTR+1 

CTPTR1 EQU © CTPTR*2 LEAST SIGNIFICANT DIGITS. 
ee 

*** BCD POSITION IN DEGREES. 

DEGRES RMB 4 


HUNDEG EQU —DEGRES CONTENTS X 100.000 

ONEDEG EQU _—DEGRES+1 CONTENTS X 1.000 

HUNDTH EQU — DEGRES+2 CONTENTS X 0.010 

THOUTH EQU DEGRES*3 «= + CONTENTS X 0.001 

eRe — mmm meeeeewwwccccesne 

ove POSITION IN DEGREES 

ee 

*** BCD COLST. 

BCOCT RMB 8 3 

TENTHO EQU = BCDCT CONTENTS X 10,000 

HUNDRD EQU = BCDCT+1 CONTENTS X 100 

TEWONE EQU  BCDCT+2 = + CONTENTS X 1 

wee = — = = = = ee wmeemwmemseewwececccccccne 

oor WUMBER OF PULSES COUNTED 

fee 

**® HYSTERESIS COUNTER. POINTS TO A NUMBER IN THE TABLE THAT IS THE 
ee AMOUNT OF HYSTERESIS PRESENT IN THE SYSTEM. INITIALIZED TO 7. 
KYSTPT RMB 1 

ee 

*** POSITION INCREMENT. CONTAINS A MUMBER, THAT WHEN MULTIPLIED BY 0.001 
oe 1S THE MUMBER OF DEGREES THAT THE POSITION COUNTER (BCDPOS) IS 


= TO BE INCREMENTED OR DECREMENTED DURING PROGRAM EXECUTION. 





195 
196 
197 
198 
199 


8 


201 


SSISRRBR 


210 
2u1 
212 


216 
215 
216 
217 
218 
219 
220 
221 
222 


224 
225 
226 


240 
241 
242 
243 
244 
245 
246 
247 
268 
249 
250 
251 
252 
253 


255 
257 


258 
259 


0022 


0023 
0024 


0025 
0026 


0027 


0000 


0081 


0085 
0088 


0080 


AE 10 
7F 
5c 
A3 27 
23 FA 


TWE VALUE OF ‘POSINC’, DETERMINED EXPERIMENTALLY, SHOULD BE 
7.0312. SINCE THE PROGRAM IS DESIGNED WORK WITH INTEGERS ONLY 
THIS NUMBER IS ROUNDED TO 7. TO REDUCE THE CUMULATIVE EFFECT OF 
THE ROUND OFF, EVERY 32 COUNTS ‘POSINC’ I¢ SET EQUAL TO 8. THIS 
AGAIN LEADS TO SOME CUMULATIVE ERROR THAT 1S ACCOUNTED FOR BY 
SETTING ‘POSINC’ TO 7 INSTEAD OF 8 WHEN THE COUNT REACHES A 
VALUE OF 16384 (2*14). 


a3 323 


1 


a 
=z 
oO 


® HYSTERESIS VARIABLES. USED YO ELIMINATE TWE EFFECTS OF BACKLASH ON 


wwe THE POSITION MEASUREMENTS. 
eee 

a THE TWRESHHOLD VALUE DETERMINED 

ne EXPERIMENTALLY. 

WYSTCT aap CURRENT AMOUNT OF HYSTERESIS MEASURED. 

eee 

e STATUS BYTE. USED TO KEEP TRACK OF WHAT IS GOING ON. 

ere 

stTaT ok CURRENT STATUS. 

LSTAT RMB PREVIQUS/LAST STATUS. USED TO KEEP TRACK OF 
wee L_SET ONLY. 

wee 

*#* TIMER COUNTER. USED IN CONJUNCTION WITH THE TIMER PRESCALER AND THE 
wes TOR TO KEEP TRACK OF ONE SEC. INTERVALS. USED IN BLINKING THE 
wee DISPLAY. INITIALLY SET TO 31, WHEN THE ‘FLASH’ BIT OF ‘STAT! 
wee IS SET. TIMCT IS DECREMENTED EACH CLOCK INTERRUPT (APPROX. 31 
owe TIMES PER SEC). RESET TO 31 WHEN CONTENTS GO TO ZERO. 

wee WHEN (TIMCT)=0 THE DISPLAY WILL TOGGLE. 


fun 
TIMCT RMB 1 
oe 


re 
ree 
RRAARAAERARERARERAEEEERAEEREREEEREEEARAREEARAAERE CHAEEAEREAAANERAEAREAHRER 


we « 
=e PAGE ZERO ROM 
ae * 


RERAERERAAERRARAAARAARAAAARERARARERERERARAERERAAAARERAEERERERRERRARARARERER 
en 

** INITIALIZATION ROUTINE. 

ae 

ae 


CODE 


ak 


ORG ZROM PAGE ZERO ROM. 


RELATIVE RELATIVE ADDRESSING MUST BE USED FOR THE BRANCH. 
oe 
RESTRT QU $s THIS IS THE ENTRY POINT WHEN THE RESET 
see SWITCH IS PUSHED. 


oe 
SRAAAAARKARERAAAEERARERRERERAAREREAAAAARERAARARAREERERAUERERARERAEREEREEE 
en 


oe INITIALIZE THE PC AND CLEAR RAM. 
wen 
eee 
SEI SET INTERUPT TO AVOID INTERUPTION AND 
RsP RESET THE STACK POINTER. JUST IN CASE! 
een 
LOX - #BINCT CLEAR ALL OF THE VARIABLES BETWEEN 
CLRIT CLR =X ‘BINCT’ AND ‘TIMCT’ CINCLUSIVE).NOTE 
INCX THAT THIS SETS THE COUNTER AND THE POS- 


CPX #TIMCT TION TO ZERO. THIS MEANS THAT ROTATION 
BLS CLRIT SHOULD START IN AN INCREASING (Cw) 
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SRBR 


SSSRSRSSSSIIIZRSBIIISSSs 


3 


S 3RRE 


$ 


0097 


$ 


0098 


OO9F 
00a! 


00A3 


O0A5 


00A7 
00a9 


OOAB 
OOAD 


OOAF 


87 04 
87 05 
87 06 


CD 03 4E 


A6 08 
B4 03 
B7 25 


1c 25 


A6 47 


B7 09 


a6 1F 
87 27 


1D OA 


DIRECTION FROM THE MOST CCW POSITION 
AFTER A RESET. 


33 


aoe 


ABSOLUTE BACK TO ABSOLUTE ADDRESSING. 
oe 
eeanereeeterrrereesteerereneerenerretntteretrretenererenHenereteeteRtETES 
wre 
eee ESTABLISH 1/0 PORTS. 
eee 


LDA #-1 PORTS A,B,C ARE CONFIGURED AS 
STA PORTACDOR ALL OUTPUT. PORT D IS ALL INPUT 
STA PORTB+DOR SO THERE IS NO MASK TO SET. 

STA PORTC+DOR 


tre 
wee 

Jsk ss OUTCT COUNT IS TO BE DISPLAYED INITIALLY. 
tee 
RERTRERAAARAAEARAEAEAAERREERAAREARAREARA TERRA AERARRERAEERREEEEEEEAREEEE 
wee SET UP THE STATUS REGISTER. 
een 

LDA =: #0001000 -- 

AND = PORTD |--> SET UP ‘L_SET’ BIT OF ‘STAT’. 

STA STAT -- 


BSET MOD_32,STAT 0 IS MODULO 32. 


ae 
RAEEREAEAAAEEEAAERRARARERAAHEERAEEAAEEEEERERAERRERAANEEAAERENERAREREEEEEE 
eee 


ene INITIALIZE HYSTCT. 
eee 

LDA #08 

STA HYST 

STA HYSTPT 
ten 


RRAARREERRAREERERERARERARRAERAERERAERAEAAEREAEESEESEREEEEREREERERERERREE 
ee 


bs SET UP THE TIMER FOR A 4 MHZ CRYSTAL / 4 = 1 MHZ CLOCK. 
enn 

ales NOTE: THE MASK OPTION REGISTER 1S IN ROM. IT IS SET UP AT 
abs THE END OF THE PROGRAM. 

wae 


REARERAAARTRERRERKRERE SET UP THE TCR. RAEARERRAERRERAREREEREREREEEREEEE 
ate 


LDA 98116+B1T2+B1T1+B1T0 
we (TIM) | (PS2)(PS1)(PSO) 
***(DISABLE INTERRUPT) |(PRESCALE BY 128) 
ae 

STA TER 
Ree 
att 
*** SET UP THE TIMER. 

Ree 
LDA = #255 1: MHZ/(128*255) = 30.6 (APPROX. 31) 
STA TIMER 


fee 
wannueneeeneneee THITIALIZE THE TIMER COUNTER. **Peeeenenseeeaesneeene 
eee 

LDA #31 PROVIDES FOR 1 SEC. BLINK INTERVAL. 

STA TIMCT FOR 2 SEC. INTERVAL JUST USE TIMECT#=62, etc. 


een 

gen 
RRAAARERREEREEEAAERRAERERRARRARERAERRERRERERERRRRERERREREERAERRERRERERE 
nt 


“ SET UP MISCELLANEOUS REGISTER. 


BCLR 86, mR ENABLES THE SECOND INTERRUPT. 
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CLI CLEAR THE INTERRUPT MASK TO GET STARTED. 


RELATIVE RELATIVE ADDRESSING MUST BE USED FOR THE 
wee REMAINDER OF THE PROGRAM. 


fee 
SELAH AAAASEAEAEAARES AEA AAE AES AERERERAE REEL ERA EER AERA AE AA EERE AEEE 
we 


** WAIT LOOP. EXECUTES, UNTIL AN INTERRUPT OCCURS. 
oe 


PAUSE BRCLR FUNCT,PORTD,CHHYST WANT TO CHANGE HYST? 

a YES...GO TO CHHYST. 
BRSET  SET,PORTD,SSIT WO...*SET,PORTD’ SET? 
BCLR L_SET, STAT WO...CLEAR ‘L_SET,STAT’ 
BRA PAUSE AND LOOP. 

SBIT BSET L_SET, STAT YES...SET ‘L_SET,STAT* 
BRA PAUSE ANO...LOOP 


ee 
a) 
ae 
** HYSTERESIS MODIFICATION ROUTINE. PERMITS MODIFICATION OF THE 
** HYSTERESIS BUFFER WITHOUT REPROGRAMMING. 
ae 
CHHYST LDA = #BIT6 DISABLE TIMER INTERRUPT. 
STA TCR 


S& 


wee 


LDA #%00001000 SAVE *L_SET’ 

AND STAT INTO 

STA LSTAT ‘USTAT’. 

LDA #%00001000 

AND PORTD ‘SET,PORTD’ --> ACCUMULATOR 

CMP LSTAT WAS THE SET SWITCH BEEN CHANGED? 
BEQ OISPLA 


NVERELRS 
aSBeRRe Ss 


YES... 
LDA =: #0001000 -- 

EOR STAT |-->CHANGE ‘L_SET,STAT’, 
STA STAT -- 

INC CRYST THEN INCREMENT THE HYSTERESIS 
INC —HYSTPT POINTER AND ‘HYST’... 


LDA HYSTPT 
CMP #25 
BLS DISPLA 

-- BUT NOT ABOVE 25. 
CLRA 
STA HYST 
STA RYSTPT 

eee 
DISPLA LDA #%00000000 NO... JUST 

STA PORTA -- 
LDA #%11000000 -- 
STA PORTB -- 

++ DISPLAY CURRENT ‘HYST’. 
Lox HYSTPT -- 
LDA TABLE ,X -- 
STA PORTC -- 

IS ‘HYST’ SETTING COMPLETE? 

BRCLR FUNCT, PORTD,CHHYST NO... KEEP CHECKING ‘SET’. 
BRSET POSCT,STAT,SHOPOS YES... RESET THE DISPLAY. 
JSR OUTCT 
BRA —- DUNCHG 


wen 


SHOPOS JSR OuTPOS 


ene 


DUNCHG BRCLR  FLASH,STAT,NO_LINT IF THE DISPLAY IS TO BLINK... 





BESSZSS 


SSSSSS8RSS3 


437 


439 
440 
441 
442 
443 


445 
447 


449 
450 
451 
452 
453 
454 
455 
456 
457 


0107 
0109 
0108 


0100 


O10F 
0112 
0115 


0117 
0119 
0118 


o11Cc 
O11E 
0121 
0122 
0124 
0126 
0128 


012A 
0120 


012E 


0131 


0133 
0135 


0137 


0138 
O13A 


NM 07 
87 09 
20 AS 


1F OA 


OA 25 10 
09 25 07 
1A 25 


Aé 07 
B7 09 
80 


18 25 
CO 03 68 
80 


A6 47 
87 09 
19 25 
18 25 


CO 03 4E 
80 


012E 
OF 09 DC 
1F 09 


3A 27 
27 01 


Aé 1F 
B7 27 


LDA #BIT2+B1T1+B1T0 ENABLE TIMER INTERRUPT AND RESET 
STA TCR TIMER PRESCALER 
INT SRA PAUSE PRIOR TO RETURNING. 


ehererer 


MAXIMUM EXECUTION TIME FOR THE REMAINDER OF THE PROGRAM OCCURS 
IF THE COUNTER ROTATES THROUGH ZERO AS THE DISPLAY MODE I$ CHANGED 
FROM THE SLINKING MODE TO THE COUNT MODE AT THE SAME TIME THAT THE 
BLINKING ROUTINE IS CAUSING THE DISPLAY TO TOGGLE TO SHOW THE 
POSITION IN DEGREES. 

MAXIMUM EXECUTION TIME = 140 + 184 «+ 708 = 1032 CLOCK CYCLES. 


MODE CWANGE ROUTINE. CHANGES THE DISPLAY MODE FROM 
COUNT -> POSITION -> BLINKING -> COUNT ->....(ETC.) 
MAXIMUM EXECUTION TIME OF 181 CLOCK CYCLES OCCURS WHEN THE 
DISPLAY MODE IS CHANGED FROM DISPLAYING THE COUNT TO DISPLAYING 
THE POSITION CIN DEGREES). 
IF THE DISPLAY IS CHANGED FROM BLINKING TO A COUNT DISPLAY 
EXECUTION TIME IS 140 CLOCK CYCLES. 


23S SFTP ITS I Fs ss 3 


CHMODE BCLR 87,mR AVOID REPEATED INTERRUPTS. 
te 


BRSET FLASH,STAT,DIS_CT IF FLASHING, DISPLAY COUNT... 
BRCLR POSCT,STAT,DISPOS IF SHOWING COUNT, DISPLAY POSITION... 


BSET FLASH, STAT ELSE, BLINK. 

we 
LOA = #BIT2*BIT1+BITO — EWABLE TIMER INTERRUPT AND RESET 
STA TCR TIMER PRESCALER. 
RTI 

ee 

DISPOS BSET  POSCT,STAT -- 
JSR OUTPOS |-- DISPLAY CURRENT POSITION, AND WAIT. 
RTI -- 

ae 

DIS_CT LDA #BIT6*BIT2+BITI+BITO DISABLE TIMER INTERRUPT AND RESET 
STA TER TIMER PRESCALER. 
BCLR  POSCT, STAT -- 
BCLR —- FLASH, STAT 

ss -= DISPLAY CURRENT COUNT, AND WAIT. 
JSR OUTCT | 
RTI -- 


an 
RERRAERARRRRERERERRARRAAERRARARAERERERRERARARRROEEEEREEE AERA ARENEEERHERE EE 
st 


** BLINK ROUTINE. INTERRUPT ROUTINE TO CHANGE THE DISPLAY FROM POSITION 


** TO COUNT OR VICE VERSA EVERY 31 ST TIMER INTERRUPT IF THE 
“* ‘FLASH’ BIT OF ‘STAT! IS SET. 
“* MAXIMUM EXECUTION TIME OF 184 CLOCK CYCLES OCCURS WHEN THE 
“* DISPLAY IS TOGGLED FROM A COUNT DISPLAY TO A POSITION DISPLAY. 
et 
BLINK EQU $ 
BRCLR —TIR, TCR, CHMODE IF THE INTERRUPT WAS NOT A TIMER 
** INTERRUPT IT MUST BE FROM INT2. 
ee 
BCLR = TIR, TCR AVOID REPEATED TIMER INTERRUPTS. 
a 
DEC — TIMCT IF THERE HAVE BEEN 31 TIMER 
BEQ = CHGDIS INTERRUPTS (1 SEC), IT’S TIME TO 
= CHANGE THE DISPLAY. 
RTI OTHERWISE, IT’S BACK TO WORK. 
ee 
CHGDIS LOA = #31 RESET TINCT TO 31 (1 SEC. INTERVAL). 
STA TINCT 


et 


94 


458 
459 


471 
472 
473 
4% 


476 


491 
492 
493 
494 
495 
4% 
497 
498 
499 
500 
501 
502 
503 
504 
505 
506 
507 
508 
509 
510 
511 
512 
513 
514 
515 
516 
517 
518 
519 
520 
521 
522 
523 


013c 
O13E 
0140 


0142 


0145 
0148 


0149 
014¢ 


0140 
0150 


0151 
0153 
0155 
0157 
0159 


0158 
0150 


015F 
0162 
0164 


0166 
0168 


86 25 
As 10 
87 25 


08 25 04 


0140 
Oa 03 01 
80 


Aé 7F 
B4 25 
87 25 
A6é 80 
B4 03 


BA 25 
B7 25 


O€ 25 09 
B6 24 
27 60 


AO 01 
B7 24 


LDA STAT =. 
EOR #%D0010000 |-- CHANGE ‘POSCT’ BIT OF ‘STAT’. 
STA STAT 7: 
ee 
BRSET POSCT,STAT,POSOUT DECIDE ON CORRECT DISPLAY. 
ee 


weatwerenees CHANGE THE DISPLAY TO SHOW THE COUNT..... ‘*t#tenwenecones 
ee 

JSR ouTct 

atl 
we 


eeteeeeneere OR HAVE THE DISPLAY SHOW THE POSITION. ‘*#ererennnenenenee 
we 
POSOUT JSR OuTPOSs 

RTI 


tt 
RERAAEAEEREEEAEEREEEEEEEERERARRERRREREAERE AE EEEERAREEENEEAERAERAREEEAOEER 
ve 


= COUNT ROUTINE. 

= WHEN A COUNT IS RECEIVED THIS 1S THE ENTRY POINT . 

ee MAXIMUM EXECUTION TIME OF 708 CLOCK CYCLES OCCURS WHEN THE 

* COUNTER ROTATES CCW THROUGH ZERO AND THE POSITION (IN DEGREES) 
st 1S BEING DISPLAYED. 


ee 
ee 


** CURRENT DIRECTION OF ROTATION IS DETERMINED BY INSPECTING THE STATUS 
** OF ‘CH_A’ AND ‘CH_B’. THE FOUR POSSIBILITIES AND THE ASSOCIATED 

** DIRECTION OF ROTATION ARE AS SHOWN BELOW. NOTE THAT THIS SCHEME 

** PREVENTS MULTIPLE OSCILLATIONS ABOUT A SINGLE POINT FROM 

** REPEATEOLY INCREMENTING OR DECREMENTING THE COUNTER. 


rk 














ee Hoccccnee te He cece weer cccceesan He cere meen eeccunces + 
** | CH_A | CHB | DIRECTION | COUNT THE PULSE? | 
oe | | OF ROTATION | | 
‘ Hee eecee Pe ccwcceee Hoc eww eco eccccce we be wwe meee ww enweences + 
we Lo Lo cw wo { 
hal Lo HI ccw YES | 
ae HI Lo | cCw nO 

ae HI HI Cw YES 
Heer ec ccce toceee weer enceeee wee bewee wee w eee cecenee + 











ae 


#eeneees FIRST SEE IF WE ARE SUPPOSED TO COUNT THIS INTERUPT. ‘*##eeeee 
we 
counT £QU = $ 

BRSET CH_B,PORTD,OKCT IF CH_B IS LO WE DON’T COUNT THE 

RTI INTERRUPT. 


we 


seneneeneneers IF THE INTERRUPT IS VALID UPDATE ‘STAT’. *##eneneeenene 
ae 


OKCT LOA 4201111191 


AND STAT SAVE ALL OF THE OLD ‘STAT’ EXCEPT THE 

STA STAT DIRECTION OF ROTATION. 

LOA #%10000000 

AND PORTD ‘CH_A,PORTD’ INDICATES THE DIRECTION 
£ OF ROTATION AND BECOMES ‘UD,STAT’. 

ORA STAT ADD THE RESULTS TO GET 

STA STAT THE WEW ‘STAT’. 


ee 


** DECIDE IF THE “SLACK" DUE TO BACKLASH/HYSTERESIS HAS BEEN TAKEN OUT. 


BRSET UD,STAT,HYSTCK IF ROTATING Cw SEE BELOW. 


LDA HYSTCT ELSE, SEE IF WE DECREMENT THIS TIME. 
BEQ cCw IF HYSTCT#O0, GO TO THE COUNT DOWN 

= ROUTINE. 
SUB #1 ELSE, DECREMENT THE HYSTERESIS COUNTER, 
STA HYSTCT 


95 





524 
525 
526 
527 
528 
529 
530 
531 
532 
533 
534 
535 


537 
538 
539 


341 
543 
545 


547 
548 
549 
550 
551 
552 
553 
554 
555 
556 
557 
558 
559 
560 
561 
562 


564 
565 


567 


570 
571 
572 
573 
574 
575 
576 
577 
578 
579 


581 
582 


584 
585 


587 
589 


O16A 


0168 
0160 
O16F 
0171 
0173 


0174 
0176 
0178 


O17A 
017¢ 
O17 


0180 
0182 
0184 


0186 
0188 
018A 
018C 
018E 
0190 
0192 
0194 


0197 
0199 


0198 


0190 
O19F 


O1A1 
01A3 
O1A5 
01A7 
019 


018 


0174 


B6 12 
AB O01 
B7 12 
Bé 11 
Ag 00 
87 11 
Bé 10 


A9 00 
B7 10 


Bé 12 
AG IF 
26 OF 
27 07 


A4 3F 
26 03 


1C 25 


20 02 


1D 25 


Bé 10 


26 14 


26 10 
26 OC 


15 25 


HYSTCK 





RTI AN WAIT FOR THE NEXT INTERRUPT. 


LOA HYST IF ROTATING CW.... 

Gi WYSTCT AND HYST = HYSTCT .... 

BEC Cw COUNT THE PULSE . 

iwc HYSTCT ELSE, INCREMENT THE HYSTERESIS COUNTER, 
rT! AND WAIT FOR ANOTHER PULSE. 


piQrns 


CLOCKWISE ROUTINE. 
EQu $ 


Sewereeeneneee INCREMENT THE BINARY COUNTER (BINCT). ‘S##teeenerneonten 


3 


eee 


wee 
tee 


LDA LOSIN BEGIN AT TKE LSB OF THE BINARY COUNTER. 


ADD # LOSIN = LOBIN + 1 ; CARRY -> C,CCR 

STA LOBIN 

LOA MIDBIN 

ADC #0 ADD THE CARRY TO THE MIDDLE BYTE. 
STA MIDBIN 

LDA HIBIN 

ADC #0 ADD THE CARRY TO THE HIGH BYTE. 
STA HIBIN 


RRARAEERRAREEREERE CLR/SET OD 32 APPROPRIATELY. RARERARORERHAREREKEEE 


set 
eke 
tee 
ner 
eer 
eee 
wee 


nee 


aren 


NOT_32 


gee 
ann 


DIRCHK 


een 
ane 


ant 


THE FOLLOWING SEVERAL LINES OF CODE ARE PRETTY MESSY. ALL THAT 
TS BEING DONE IS TO ENSURE THAT THE SCALE FACTOR IS SET PROPERLY. 
FOR THE PAN AXIS THE SCALE FACTOR IS; 


1 PULSE => 0.007097 DEGREES 


LDA LOBIN IF THE LOW FIVE BITS OF ‘LOBIN’ ARE NOT 

AND = #%00011111 += ZERO THEN THE NUMBER ISN’T A MODULO 32 NUMBER. 
BNE = NOT_32 

LOA = MIDBIN IF THE LOW SIX BITS OF ‘MIDBIN’ ARE ZERO 

BEQ MOD AND ‘HIBIN’ .WE. ZERO 

ANO = #%00111111 © THEN THE NUMBER IS MODULO 16,384, AND WE 

BNE MOD DON’T WANT TO SET ‘MOD_32,STAT’, UNLESS 


BRCLR B6,MIDBIN,NOT_32 THE NUMBER IS ALSO MODULO 32,768. 


BSET  MO0_32,STAT 
BRA DIRCHK 


BCLR  MOD_32,STAT 


LDA HIBIN 

64] CWNEG IF HIBIN <0 , WE/RE ROTATING CCW TOWARD 
THE ORIGIN. 

BNE CwPOS 

LDA MIDBIN ELSE IF BINCT .WE. 0 

BNE CwPOS WE’RE ROTATING CW 

LDA LOBIN AWAY FROM THE ORIGIN. 

BNE CwROS 


ELSE, WE'VE ROTATED CW THROUGH THE ORIGIN. 
BCLR WEGTIV,STAT CLR NEGATIVE SIGN. 








B83 


sSSSBSRRSER 





O1AD 
O1AF 
0180 
0181 
0183 
0185 


0187 
0189 
01BC 


O1BE 
01C1 
0104 


01C6 
01C8 
O1CA 
o1cc 
O1CE 
0100 
0102 
01D4 


0107 
0109 


0108 


0100 
O10F 
O1E1 


O1E3 
O1E5 
O1E7 


O1E9 
O1EB 
O1ED 


O1EF 
O1F1 


O1F3 
O1F5S 
01F7 
O1F9 
O1FB 


z 


S88 FRR & 
£$ 


888 888 


86 12 
Ad 1F 
26 OF 
Bé 11 
27 07 
AG 3F 
26 03 
00 11 04 


1 25 
20 02 


1D 25 


B6 12 
AO 01 
B7 12 


86 11 
A2 00 
B7 11 


Bé 10 
A2 00 
B7 10 


B6 10 
2a 29 


Aé FF 
B1 10 
26 1C 
Bt 11 
26 18 


LOX wPTR4 -- 
CLRIT2 CLR Xx =< 
TNCX ~°RESET ALL COUNTERS AND DEGRES TO ZERO. 


BLs CLRIT2 -- 


BRA ss: UPOUT UPDATE OUTPUT. 
eet 
CwPOS BSR  — ADDBCD 
JsR ——INCPOS 
BRA ss UPOUT 
tre 
CEG JSR =: SUBBED 
JsR ss INCPOS 
BRA ss: UPOUT 
eee 
eet 
SEPARA ERARREEREEEREEEAEREREAEEERRAARERARARAERERAEREAER ERE EE SERRE EEEE 
ee 
* COUNTER-CLOCKWISE ROUTINE. 
ee 


Ccw Equ $ 


RRAARAEAREEERRAAAEEE CLR/SET MOD 32 APPROPRIATELY. RRAERAAAAEEEAERENERRR 


eae 


ase AGAIN SET THE SCALE FACTOR TO; 


ake 


oe 1 PULSE => 0.007097 DEGREES 
wee 
LDA LOBIN IF THE LOW FIVE BITS OF ‘LOBIN’ ARE NOT 
ANO =—--#%00011111 ZERO THEN THE NUMBER ISN’T A MODULO 32 NUMBER. 
BNE  —- NO_32 
LDA = MIDBIN IF THE LOW SIX BITS OF ‘MIDBIN’ ARE ZERO 
BEG = MODLO AND ‘HIBIN’ .WE. ZERO 
AND  =-#KOO111111 «THEW THE NUMBER IS MODULO 16,384, AND WE 
BNE MODLO DON’T WANT TO SET ‘MOD_32,STAT’, UNLESS 


BRCLR 86,MIDBIN,NO_32 THE NUMBER IS ALSO MODULO 32,768. 
Ree 
MOOLO 8 BSET MOD_32,STAT 
BRA DECBIN 
tke 
NO_32  BCLR = MOD_32,STAT 
wee 
ak 
PRAAARARARERERE DECREMENT THE BINARY COUNTER (BINCT). RREARARERREEAREE 
ear 
DECBIN LDA LOBIN BEGIN AT THE LSB OF THE BINARY COUNTER. 
SUB #1 LOBIN = LOBIN - 1 ; BORROW -> C,CCR 
STA LOBIN 
wee 
LOA MIDBIN 
sec #0 SUBTRACT THE CARRY FROM THE MIDOLE BYTE. 


STA MIDBIN 
ove 


LDA HIBIN 

ssc #0 SUBTRACT THE CARRY FROM THE HIGH BYTE. 

STA HIBIN 
wee 

LDA HIBIN 

BPL CCwPOS IF HIBIN .GE. 0 , WE‘/RE ROTATING CCW TOWARD 
me THE ORIGIN. 

LOA #-1 v2 

CMP HIBIN =e 

BNE CCWNEG -- ELSE IF BINCT .NE. -1, 

Cap MIDBIN -- WE'RE ROTATING CCW AWAY 

BNE CCWNEG -- FROM THE ORIGIN. 


97 


LOBIN 
CCWNEG -- 


WEGTIV,STAT ELSE, WE'VE GONE TWROUGH ORIGIN IN CCW 
DIRECTION. SET NEGATIVE SIGN. 
AND SET ALL COUNTERS APPROPRIATELY. 


-- DEGRES = 360.00 


e> EVERYTHING ELSE IS ZERO BEFORE CHANGE. 


ate 
eee 
tt 
RRRERAAAAARERARAARERARAARERAREAEREREREREREERERREREEEREERREREERE HEATER 
a 


** OUTPUT ROUTINE. ROUTINE TO PRINT DATA TO THE OUTPUT PORTS. BY 
bid CALLING THE APPROPRIATE SUBROUTINE.(’OUTCT’ TO OUTPUT THE 
** THE COUNT AND ‘OUTPOS’ TO OUTPUT THE POSITION). 


te 
UPOUT EQU $ 
os 


BRCLR POSCT,STAT,PUTCT 
on 

JSR OUTPOS 

RTI 
ae 
PUTCT JSR OUTCT 

RTI 


ak 
RRAEKERARRARRARRERARARRERRRERRARARARERREREERERRARERRERRRRRRRARRREERERERHRE 
waeeneeeens SUBROUTINE TO INCREMENT THE BCD COUNTER (BCDCT). *##eennee 
wee 
ADDBCD LDA = CTPTRI 

ADDO 

CMP = #99—sCCTPTR > 99? 

BLS  OK1 ~=—sNO, WE/RE OK HERE. LOOK UP THE FIRST TWO DIGITS. 

SUB #100-—=—s YES... MODIFY THE CTPTR, 

SEC SET THE CARRY, AND 

BRA OKA_—sUSE TABLE LOOK UP. 


cic WO CARRY EXISTS IF WE ENTER AT THIS POINT. 
STA CTPTRi -- 
TAX =< 
-- LOOK UP THE TWO LEAST SIGNIFICANT DIGITS. 
LDA TABLE,X -- 
STA TENONE -- 
NOMO AND CONTINUE ONLY IF THERE WAS A CARRY. 


CTPTR2 

#0 ADD THE CARRY. 

a9 CTPTR > 99 ? 

OK2 NO, WE'RE OK HERE. LOOK UP THE NEXT TWO DIGITS. 





SAeaPa PARI Aras sAaA 


a 


776 


dgagaesezIIy 


0240 
O24F 
0250 


0252 
0253 
0255 


0256 
0259 
0258 


025F 
0261 


0264 
0267 


0269 


026A 


026D 
026F 


0271 
0273 


0275 
0277 
0279 
0278 
027D 
027F 
0280 


0282 
0283 
0285 


0286 
0289 
0288 


0280 
O28F 
0291 
0293 
0295 
0297 
0298 


029A 
0298 


AO 64 
20 01 
87 18 
97 

06 03 
87 1F 
24 OC 
6 17 
A9 00 
87 17 
97 


Dé 03 
B7 1E 


81 


0D 25 


Aé 08 
20 02 


Aé 07 
87 22 


FRASa 


S8SRz258 
= 


3 


B7 15 





sus #100 YES... MODIFY THE CTPTR, 
SEC SET TWE CARRY, AND 
BRA OK2A USE TABLE LOOK UP. 


ene 


ox2 cLc WO CARRY EXISTS IF WE ENTER AT THIS POINT. 
OK2A ss STA CTPTR2 -- 
TAX -- 
oon -- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 
LDA TABLE,X -- 
STA WUNDRD -- 
ecc woMo AND CONTINUE ONLY IF THERE WAS A CARRY. 
gee 
LDA ss CTPTR3. 
ac 80 ADD THE CARRY. 
STA CTPTR3 -- 
TAX -- 
ore +> LOOK UP THE NEXT TwO DIGITS IN THE TABLE. 


LDA = s« TABLE,X = -- 

STA TENTHO -- 
eee 
WOMO «RTS 
wee 
RERAAAARERRAAEAARAAERAEAEEREREAEREAEEREREAAEERAARE RATER EAEEEEEEAREAERENAEEE 
weeeeee SUBROUTINE TO INCREMENT THE POSITION COUNTER (DEGRES). *eeeeee 
eee 
ewes FIRST CHECK TO SEE IF THE BINARY COUNTER HAS REACHED A MODULO 32 
wees = NUMBER. 
aaeen 


IWCPOS BRCLR WOD_32,STAT,INC7 ‘MOD_32,STAT’ SET ? 


wren 


LDA #8 YES ... 

BRA TNC INCREMENT THE POSITION BY 0.008 DEGREES. 
rene 
INC7 LDA #7 WO ..05 


INC STAs POSINC 
ater 

*#** ROUTINE TO INCREMENT THE POSITION COUNTER , ‘DEGREES’ ,BY A 
eee = PREDETERMINED AMOUNT, ‘POSINC’, 


wake 


INCREMENT THE POSITION BY 0.007 DEGREES. 


LDA PTRi 
ADD POSINC 
Cup "9 PTR1 > 9? 


BLS OK3 NO, WE'RE OK HERE. LOOK UP THE FIRST DIGIT. 
SUB #10 YES... MODIFY THE CTPTR, 

SEC SET THE CARRY, AND 

BRA OK3A USE TABLE LOOK UP. 


aeek 


oK3 = sce NO CARRY EXISTS If WE ENTER AT THIS POINT. 
OK3A «STA. séPTRYste- 
TAX -- 
seen ++ LOOK UP THE LEAST SIGNIFICANT DIGIT. 
LDA ss‘ TABLE,X = -- 
STA THOUTH -- 
BCC =: DONE AMO CONTINUE ONLY IF THERE WAS A CARRY. 
Reee 
Saenr 
LDA PTR 
aoc #0 ADD THE CARRY. 


Cap #99 PTR2 > 99 2? 
BLS OK4 WO, WE'RE OK HERE. LOOK UP THE NEXT TWO DIGITS. 
suB #100 YES...MODIFY THE CTPTR, 
SEC SET THE CARRY, 
BRA OK4A ANO USE TABLE LOOK UP. 
ween 
OK4 cic WO CARRY EXISTS IF WE ENTER AT THIS POINT. 
OK4A STA PTR2 <5 


99 


*+ LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 


AND CONTINUE ONLY IF THERE WAS A CARRY. 


ADO THE CARRY. 

PTRS > 99? 

WO, WE/RE OK HERE. LOOK UP THE WEXT TWO DIGITS. 
YES... MODIFY THE CTPYR, 

SET THE CARRY, AND 

USE TABLE LOOK UP. 


WO CARRY EXISTS IF WE ENTER AT THIS POINT. 


~- LOOK UP THE WEXT TWO DIGITS IN THE TABLE. 


SSSSSRBSSSssZFAZasIZIez 


ANDO CONTINUE ONLY IF THERE WAS A CARRY. 


aoc ADD THE CARRY. 
STA -- 
TAX -- 
-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 
LDA -- 
STA HUNDEG -- 
were 
DONE RTS 
enn 
we 
RRAEARERAARAEARARERREREERERERRAEEARAEREEREREEREERERAAAERERERAEREAAEREAREE 
#eeeeees SUBROUTINE TO DECREMENT THE BCD COUNTER (BCDCT), ****seeeneee 
ren 
SUBBCD LDA = CTPTR1 
suai CTPTR > 99 7 


Bcc OK6 NO, WE'RE OK HERE. LOOK UP THE FIRST TWO DIGITS. 
ADD #100 YES, MODIFY THE CTPTR, AND 
SEC GENERATE A BORROW. 


STA CTPTRY -- 
TAX “= 
-° LOOK UP THE TWO LEAST SIGNIFICANT DIGITS. 
LDA TABLE,X = -- 
STA TENONE -- 
BCC COMPLT AND CONTINUE ONLY IF THERE WAS A BORROW. 


LDA CTYPTR2 

sac #0 SUBTRACT THE CARRY. CTPTR > 99 ? 

Bcc OK7 WO, WE/RE OK WERE. LOOK UP THE NEXT TWO DIGITS. 
ADD #100 YES, MODIFY THE CTPTR, ANO 

SEC GENERATE A BORROW. 


STA CTPTR2 -- 
TAX -- 
-+ LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 
LDA TABLE,X = 
STA WUNORD -- 
Bcc COMPLT AND CONTINUE ONLY IF THERE WAS A CARRY. 


LDA CYPTRS 
sBc #0 SUBTRACT THE BORROW. 





SSSS3SFSSISSSSRSERRRREE 


3 
wo 


SS8R88 


910 
911 
912 
913 
914 
915 
916 
917 
918 
919 


024 
02F6 


02F7 
O2FA 


o2FC 


O2FD 


0302 


0308 
030A 
030c 
O30E 
0310 


0311 
0313 


0314 
0317 
0319 


0318 
031D 
031F 
0321 
0323 


0324 
0326 


0327 
O32A 
o3ec 


O32E 
0330 
0332 
0334 
0336 


0337 
0339 


O33A 
0330 
O33F 


87 17 
97 


06 03 
B7 1E 


81 


88 & 


SE BR 8 
Rg 


86 16 
BO 22 
24 03 
AB OA 


B7 16 
97 


06 03 
87 10 
24 32 


B6 15 
A2 00 
24 03 
AB 64 


B7 15 
97 


Dé 03 
B7 1C 
26 IF 


B6 14 
A2 00 
24 03 
AB 64 


B7 14 
97 


06 03 
87 18 
24 0C 


STA 
TAX 
wen 
LDA 
STA 
eee 
COMPLT RTS 
awe 


CTPTR3 -- 

-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 
TABLE,X = -- 
TENTHO -- 


eeeereterererterrerrenenrerrrerenetereteerererreeneererreresereneeterTEs 
@enewes SUBROUTINE TO DECREMENT THE POSITION COUNTER (DEGRES). ‘***e*ee 


ewes FIRST CHECK TO SEE IF THE BINARY COUNTER HAS REACHED A MODULO 32 


ree 
ooo 
tree 
DECPOS BRCLR 
eoen 
LOA 
BRA 
wtrot 
DEC7 LDA 
DEC STA 
wane 


anne 
reek 
weak 


aeak 


OK8 


eke 


wee 
ane 


war 


OK9 


wee 


aan 
een 


tke 


OK10 


aeanr 


ake 


MOD_32, STAT ,DECT 1W00_32,STAT’ SET ? 

#8 YES... 

DEC DECREMENT TWE POSITION BY 0.008 DEGREES. 
"7 WO cease 

POSINC DECREMENT THE POSITION BY 0.007 DEGREES. 


ROUTINE TO DECREMENT THE POSITION COUNTER , DEGREES’ ,BY A 
PREDETERMINED AMOUNT, ‘POSINC’. 


LDA 
SUB 
gcc 
ADO 
SEC 


STA 
TAX 


LOA 
STA 
Bcc 


LDA 
spc 
Bcc 
ADD 
SEC 


STA 
TAX 


LOA 
STA 
Bcc 


LDA 
sBc 
Bcc 
ADD 
SEC 


STA 
TAX 


LDA 
STA 
Bcc 


PTR 
POSIWC PTRI <0? 
OKs NO, WE/RE OK HERE. LOOK UP THE FIRST DIGIT. 
#10 YES, MODIFY THE CTPTR, AND 
GENERATE A BORROW. 


PTRI-- 

-- LOOK UP THE LEAST SIGNIFICANT DIGIT. 
TABLE,X = -- 
THOUTH -- 
DUNSUB AND CONTINUE ONLY IF THERE WAS A BORROW. 
PTR2 
#0 SUBTRACT THE BORROW. PTR2 <0 ? 


OK9 NO, WE'RE OK HERE. LOOK UP THE NEXT TWO DIGITS. 
#100 YES, MODIFY THE CTPTR, AND 
GENERATE A BORROW. 


PTR2-- 

-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 
TABLE,X -- 
HUNDTH -- 
DUNSUB AND CONTINUE ONLY IF THERE WAS A CARRY. 
PTR3 
#0 SUBTRACT THE BORROW. PTR3 <0? 


OK10 NO, WE/RE OK HERE. LOOK UP THE NEXT TWO DIGITS. 
#100 = YES, MODIFY THE CTPTR, AND 
GENERATE A BORROW. 


PTR3-- 
-+ LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 
TABLE,X -- 
ONEDEG -- 
DUNSUB AND CONTINUE ONLY IF THERE WAS A CARRY. 


101 


SISISIS 


8 
~“ 


FSSsRSRaFaess3s 


971 
972 
973 
976 


976 
977 
978 
979 


961 


985 


0341 
0343 
0345 
0347 


O34E 
0350 


0352 
0354 


0356 
0358 


035A 
035c 


O35€ 
0361 
0363 


0365 
0367 


0368 
036A 
036C 
036€ 
0370 
0372 
0374 
0376 
0378 
037A 
037¢ 
037E 


0380 
0382 
0384 


86 13 
A2 00 
87 13 
97 


06 03 BE 
87 1A 


81 


B6 20 
87 02 


B6 1F 
87 00 


B6 IE 
B7 01 


1E 01 
19 01 


04 25 04 
1¢ 01 
20 02 
1D 01 


81 


LDA PTRE 


sec #0 SUBTRACT THE BORROW. 
STA PTRS < 
TAX T= 
eeee -* LOOK UP THE NEXT TWO DIGITS IW THE TABLE. 
LDA TABLE,X -- 
STA WUNDEG -- 


ee 
** OUTPUT COUNT (OUTCT). SUBROUTINE TO MOVE THE CURRENT COUNT (BCDCT) 
“ TO THE OUTPUT PORTS. REMOVES TWE DECIMAL POINT FROM THE 
“ DISPLAY AND BLANKS ALL BUT THE LEAST SIGNIFICANT DIGIT. ALSO 
** SETS THE MINUS SIGN IF APPROPRIATE. 
ee 
curcT equ $ 
ee 
LDA TENONE 
STA _—PORTC 
at 
LDA HUNDRD 
STA PORTA 
ae 
LDA TENTH 
STA —-PORTB 


ae 


BSET  DECPT,PORTB 
BCLR BLANK, PORTB 
ae 
BRSET WEGTIV,STAT, MINUS 
BSET  POSTIV,PORTB 
BRA ALLDUN 
an 


MINUS BCLR POSTIV, PORTS 
oe 


ALLOUN RTS 
oe 


ae 


** QUTPUT POSITION (OUTPOS). SUBROUTINE TO MOVE THE CURRENT POSITION 
“* COUNT (BCDCT) TO THE OUTPUT PORTS. THE DECIMAL POINT IS 
** DISPLAYED , AND ONLY THE MOST SIGNIFICANT DIGIT IS BLANKED. 


we 


OUTPOS EQU $ 


et 


LDA THOUTH -- 
Cup 6 = 
BLO TRUNC “2 IF 5 > ‘THOUTH’ SIMPLY TRUNCATE THE 
LDA HUNDTH -* DISPLAY. OTHERWISE... 
AND # -- IF THE LAST DIGIT ISN’T A WINE IT IS 
Cup #9 -* EASY TO ROUND UP. JUST ADD A ONE. 
SNE DECIMAL 26 
LOA HUNOTH -- BUT IF THE LAST DIGIT IS A NINE CHECK TO 
cup #899 -- SEE IF IT’S 99. IF SO IT GETS GRIM. 
BEQ UGLY se 
ado #7 -> IF THE WUMBER IS X9 AND X .NE. 9, THEN 
BRA PCOUT -* JUST ADO SEVEN TO ROUND UP. DUE TO 
ee o> WEXIDECIMAL. 
bc -- If THE LOW TWO DIGITS ARE BOTH WINES 
UGLY LDA #00 -- AND WE NEED TO ROUND UP.... 
STA PORTC a5 MAKE THE LOW TWO DIGITS BOTH ZEROS 
SEC as AND SET THE CARRY. 
we 
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$88882888833239222333882 


1010 
1011 
1012 
1013 
1014 
1015 
1016 
1017 
1018 
1019 
1020 
1021 
1022 
1023 
1024 
1025 
1026 
1027 
1028 
1029 
1030 
1031 
1032 


1033 
1034 
1035 
1036 
1037 
1038 
1039 
1040 
1044 


0397 


O3AF 


0381 
0383 
0385 


0387 
0389 
0388 


0380 


O38E 
03¢3 
03c8 
03cO 
0302 
0307 
030C 
O3E1 
O3E6 
O3€8 
O3FO 
O3F5 
O3FA 
O3FF 
0404 
0409 
040E 
0413 
0418 
0410 


eQR8enBsa 


88 Sa a 88 


[3k B3F BQ SE SSRK SENZAKKARE 
ow 


88a 


00 01 0 
05 06 0 
10 11 1 
15 16 4 
20 21 
25 26 
30 31 
35 36 
40 41 
45 46 
50 51 
55 


RSRSAIBTES 
KLKSHVESS 


QSSRAINGRANSKSKG 


NNN 


SAISRASARGSUVEGRUSRSABE 
SRSRIXSKFSLSESEBSRSESR 


RLUGLY 


DECIMAL 


te 


TRUNC 
PCOUT 


WEXT 
PAOUT 
oe 
WEXT1 


an 


we 


oe 
ae 





LDA 
BNE 
LOA 
SEQ 


LDA 
STA 


LOA 


STA 


LDA 
STA 
cic 


LDA 
aoc 
STA 


LDA 
aoc 
STA 


BSET 
BSET 
BCLR 


RTS 


WUNOTH -- 
#i “= 


PORTC on 
NEXT =< 


WUNDTH -- 
PORTC -- 


ONEDEG 
#0 
PORTA 


HUNDEG 
#0 
PORTB 


POSTIV, PORTB 
BLANK, PORTB 
DECPT, PORTB 


CHECK THE LAST DIGIT AS BEFORE. 

IF USING THIS PORTION OF THE CODE 
TWERE WAD TO BE A CARRY. 

IF THE LAST DIGIT 16 WOT A NIWE USE THE 
ADC INSTRUCTION BELOW. 

IF IT 18 A WINE, IS THE NEXT ONE A WINE 
ALSO? 

IF WOT JUST ADO SEVEN, 

AND DISPLAY THE OUTPUT. 


IF SO ROUND UP THE MOST SIGNIFICANT 
DIGIT AND SET EVERYTHING ELSE TO ZERO. 


THIS IS ALL THAT NEEDS TO BE DONE IF 
THE LAST DIGIT IS NOT A NINE. 


AND IF THERE IS NO CARRY IT’S EVEN EASIER. 


REERAAAAEERAAAAARERRARRARARARRERAARARREEAEAREEREEREREERERERARAHETRRREER 


en 


** SET UP THE TABLE TO BE USED WITH BCD INCREMENT/DECREMENT ROUTINES. 


wt 
* 
2 


TABLE 





ENDS 
DATA 
FCB 
FCB 
FCB 
FCB 
FCB 
FCB 
FCB 
FCB 
FCB 


FCB 


$00, $01, $02,$03,$04 ,$05 ,$06,$07, $08, $09 


$10,$11,$12,$13,$14,$15,$16,817,$18,$19 


$20, $21, $22, $23, $24, $25, $26, $27, $28, $29 


$30 $31, $32,$33 ,$34,$35 , $36,837, $38,839 


$40 $41, $42,343 $44,845 , $46,847, $48, $49 


$50,851, $52,$53,$54,$55,$56,$57,858,$59 


$60 $61 , $62, $63 , $646,865 , $66,867, $68, $69 


$70,$71,$72,$73, $74 ,$75,$76,%77,$78,$79 


$80, $81 , $82, $83 , $84 ,$85 , $86,387, $88, $89 


$90 ,$91 , $92,893 ,S% , $95 , $96, $97, $98, $99 
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1042 
1043 
1064 
1045 
1046 
1067 
1048 
1049 
1050 
1051 
1052 
1053 
1054 
1055 
1056 
1057 
1058 
1059 
1060 
1061 
1062 
1063 
1064 
1065 
1066 
1067 
1068 
1069 
1070 
1071 
1072 
1073 
1074 
1075 
1076 
1077 
1078 
1079 


0422 


OF38 
OF38 


OFF8 


OFFS 
OFFA 
OFFC 
OFFE 


1000 


Lines Assembled : 


07 


O12E 
0140 
0140 





* ENDS 
* CODE 
SHRAAARETARAAEEAAE TERE EERAAERERRARASESEAREORUEEHERENRHEETeeHeeeeeeheret 
ee 
. SET UP MASK OPTION REGISTER. 
we 
ABSOLUTE 
ee 
oe 
ORG = MOR 
FCB = @BIT2eB1T 198170 
we 
ad COMMENTS: 
. BIT 7 CLOCK SOURCE 0 = CRYSTAL. 
a BIT 6 TIMER OPTION 0 = INTERNAL. 
* BITS  TIWER/CLOCK SOURCE 0 © INTERNAL. 
we BIT 4 WOT USED. 
BIT 3 MOT USED. 
+ BiT2 ser - 
+e BIT 1 SET  - PRESCALE SELECT 111 => 128 
** BITO ser - 
2 
we 


RHARARARAREEAERERREREREAARERERERAEREEESREREREEEHEEERORNEKEREEREREENKEEED 


ORG 


FOB 
FOB 
FOB 
FOB 


oe 
os 
ee 
ENDS 
END 
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ASSIGN INTERRUPT VECTORS. 
INTRPT 
BLINK TIMER/INT2 INTERRUPT VECTOR. 
COUNT EXTERNAL INTERRUPT VECTOR. 


COUNT SOFTWARE INTERRUPT VECTOR, NOT USED. 
RESTRT RESET VECTOR. 


Assembly Errors : 0 
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C. TILT 


TTL POSITION DETERMINING PROGRAM (ELEVATION) 
. LATEST REVISION 9 MAY 89 
. FILE NAME TILT. ASH 


*® PROGRAM DESCRIPTION 


ee 
ee 
ee 


BWOnauw Fun ow 


** 1/0 REGISTER ADDRESSES 
10 ee 


11 0000 PORTA €QU $0000 1/0 PORT A 
12 0001 PORTS €QU $0001 1/0 PORT B 
13 0002 PorTc EGU $0002 1/0 PORT C 
14 0003 PORTD EQU $0003 = INPUT PORT O 
18 ee 
16 *® DATA DIRECTION REGISTER OFFSET 
17 on 
18 0004 DDR EQu 4 (eg. DOR FOR PORT A IS PORTA+DDR ) 
19 ee 
20 ** OTHERS 
21 an 
22 0008 TIMER EQU $0008 EIGHT BIT TIMER REGISTER. 
23 0009 TCR EQu $0009 TIMER CONTROL REGISTER. 
24 OO0A MR EQU SOOOA MISCELLANEOUS REGISTER. 
25 0010 RAM €QU $0010 START OF ON-CHIP RAM(112 - 31 FOR STACK) 
26 0080 ZROM Equ $0080 PAGE ZERO OF ROM. 
27 0100 ROM eau $0100 START OF MAIN ROM. 
28 OF38 MOR equ SOF38 MASK OPTION REGISTER. 
29 OFFS INTRPT €QU SOFF& LOCATION OF INTERRUPT VECTORS. 
30 1000 MEMSIZ EQU $1000 MEMORY ADDRESS SIZE. 
34 on 
32 * EQUATES 
33 eo 
34 0001 B1T0 EQu 1 
35 0002 Birt EQU 2 
% 0004 BIT2 EQu 4 
37 0008 BITS EQu 8 
38 0010 BITS QU 16 
39 0020 BITS EQu 32 
40 0040 BIT6 EQU 64 
41 0080 BIT7 EQu 128 
62 ee 
43 0000 B0 EQu 0 
4 0001 B1 equ 1 
45 0002 B2 Equ 2 
46 0003 63 EQu 3 
47 0004 84 EQu 4 
48 0005 85 €ou 5 
49 0006 86 EQu 6 
50 0007 87 EQu 7 
81 ee 
52 ** EQUATES FOR THE TIMER CONTROL REGISTER 
oe 
+4 ene 
35 0007 TIR EQu 7 TIMER INTERRUPT REQUEST. 1 = REQUEST, 0 = NO REQ. 
56 0006 Tim equ 6 TIMER INTERRUPT MASK. 1 © DISABLED, 0 = EWABLED. 
57 0005 Ti Eau 5 EXTERNAL OR INTERWAL CLOCK SOURCE. 1 = EXT, 0 = INT. 
58 0004 TEE Eou 4 EXTERNAL CLOCK ENABLE. WOT USED. 
59 0003 PSC eeu 3 PRESCALER CLEAR. WOT USED. 
60 0002 ps2 Eou 2 (PS2)_-- 
61 0001 psi Eou 4 ¢PS1) {-- PRESCALER SELECT BITS. 
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SSELESRASLSESELRKAKKKALSASIRARANISSEIEAFAR 


127 


g 


BERSE8 


0007 


0004 


0007 


PscoE@UtC«ié (P80) -- 

ee 

* EQUATES FOR THE STATUS BYTE, ‘STAT’. 

eee 

eee 

et 

up ew 7 COUNT DIRECTION? 1 = UP, 0 = DOW. 

moo.32 EU 6 1S “BINCT’ MODULO 327 1 © YES, 0 = NO. 
FLASH EQU OS BLINK THE DISPLAY? 1 = YES, 0 = MO. 

posct EQU 4 DISPLAY POSITION OR COUNT? 1 = POS, 0 = COUNT. 
LseT EU 3 VALUE OF “WODE,PORTD’ LAST TIME. 

MEGTIV EQU 2 18 ‘BCOCT‘NEGATIVE NUMBER? 1 = YES, 0 = NO. 
we 1 MOT USED. 

owe 0 MOT USED. 

ene 

eee 


** 1/0 EQUATES AND DESCRIPTIONS. 

eee 

wee 

eee PORT A (1/0) 

wre 

ore Hoeccces Poweccce Hoewccce Poccecee Pocceeee Homer cnnge wanes orewcce + 
owe | BCD DIGIT #% | BCD DIGIT #3 | 
eee Poccccce Ho eeccee Hoocccce Pocccene Hocccees Hoecccee Hoseceee Hocccece + 
“or dt TTT] OTC] CTC 
wee Hoecccee Poccccee Heecccee Ho crecee Heecenee Soc ceeee Poreccce So ewnece + 
*e* BIT 7 6 5 é 3 2 1 0 
een 

wen 

one PORT B (1/0) 

eee 

fee Pec ceeee Pee eceee Hrcccece eo ccccee Powe ccee Hom en sede occne Se eeccee + 
eee | DISPLAY CONTROL | oT USED | 
en Porcccce Poececee Heeccene Hoecccee Hee eewee oenwwee Howenene Porenewe + 
eee | DECPT | PosTIV| | BLANK | | | | | 
een toocee tebe ccc cnge eweeee te ccceee gecccene Here eenndnwwcece Hoccceee + 
eee BIT 7 6 5 4 3 2 1 0 
oon 

OECPT EQU 7 TO DISPLAY THE DECIMAL POINT...DECPT IS CLEARED 
POSTIV EQU 6 USED TO DISPLAY NEGATIVE SIGN...CLEARED TO SHOW 
eee MINUS SIGN. 

BLANK €EQU 4 TO BLANK DIGITS 2 AND 3...CLEAR BLANK. 

bphatad DIGITS 4 AND 5 ARE ALWAYS BLANKED. 

“ee DIGIT 1 IS NEVER BLANKED. 

wae 

ak PORT C (1/0) 

een 

wen Poccccee taccccee toeccese Hoccecee Poocccce He mccene He ewecce Hoeccsoe + 
wee | BCD bIsit #2 |8CD DIGIT vient ate] 
ene Heecceee Hacc gemenene Hocccces Hoenenee Pere w cede meses Hocceee 
os =| oz | c2 | e2 | a | or yc) | ety at | 
eee Hocccnce pa eecees Ha wcwcee Heocccce Gemwwccn Ho cccces Hoennecn Poceene + 
eee BIT 7 6 5 4 3 2 1 0 
eee 

oon 

ae PORT D CINPUT ONLY) 

won 

wen Poocerne Poocccee pocerone Poe ccee Hoeccece Pocereredeccncce Poeccee + 
oon { CHA | ante | Coe | Baer | se | | | I 
een Hoorccee Perce cc nde cccecehonesscegocces tego ceccce Soenevecs Poecece + 
eee BIT 7 6 s 4 3 2 1 0 
eee 

CH_LA EQU 7 IWOICATES THE STATUS OF CHANNEL A. 

INT2 EQu 6 INTERRUPT #2. USED TO CHANGE DISPLAY MODES. 

CH_8 EQu 5 IWOICATES THE STATUS OF CHANNEL B. 

FUNCT  EQU 4 USED TO PUT THE PROGRAM IN A MODE THAT WILL ALLOW 
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128 
129 
130 
431 
132 
133 
134 
135 
136 
137 
138 
139 
140 
161 
142 
143 
144 
145 
146 
147 
168 
149 
150 
151 
152 
153 
154 
155 
156 
157 
158 
159 
160 
161 
162 
163 
164 
165 
166 
167 
168 
169 
170 
171 
1Te 
173 
17% 
175 
176 
177 
178 
179 
180 
181 
182 
183 
184 
185 
186 
187 
188 
189 
190 
191 
192 
193 


0010 


0010 


0012 


0015 


0017 


OO1A 


oo1c 


0010 
0011 


0012 
0013 
0014 


0015 
0016 


0017 
0018 
0019 


OO1A 
001B 


See ‘MYST’ TO BE INCREMENTED. 
SET EQU 3 INCREMENTS ‘HYST’ WHEN TOGGLED AND FUNCT I$ LOW. 


eee 

eee 

REREAAEEERAAEEEAERERELAERERERERESAEREERERERERARAEAEARERAREEEOEREEHERE RAE 
J 


RAM VARIABLES _ 


RESERVE MEMORY SPACE FOR THE PROGRAM VARIABLES. 
DATA 


ABSOLUTE (ABSOLUTE ADORESSING USED WERE TO RELATIVE DIRECTIVE) 
ORG RAM START OF RAM. 


3 2 ff 232 


*** BINARY COUNT. 

BINCT RMB 2 

HIBIN EQU BINCT HI BYTE. 
LOBIN EQU BINCT+1 LO BYTE. 
oe 


*** POSITION POINTERS. 


PTR RMB 3 EACH BYTE POINTS TO A POSITION IN THE 
oe TABLE THAT CONTAINS ONE OR TWO DIGITS 
oe OF THE BCD POSITION. 

PTRS EQU PTR MOST SIGNIFICANT DIGITS. 

PTR2 EQU PTR+1 

PTR1 EQU PTR#2 LEAST SIGNIFICANT DIGIT. 

ee 

*ee COUNT POINTERS. 

CTPTR RMB 2 EACH BYTE POINTS TO A POSITION IN THE 
ial TABLE THAT CONTAINS TWO OF THE DIGITS 
ve IN THE BCD COUNT. 


CTPTR2 EQU CTPTR MOST SIGNIFICANT DIGITS. 
CTPTR1 EQU CTPTR+1 LEAST SIGNIFICANT DIGITS. 
oe 


*** BCD POSITION IN DEGREES. 
RMB 3 


DEGRES 

ONEDEG EQU ——DEGRES CONTENTS X 1.000 

HUNDTH EQU —DEGRES+1 CONTENTS X 0.010 

THOUTH EQU DEGRES+2 + CONTENTS X 0.001 

Wee wm wm mew ce cccncccces 

wee POSITION IN DEGREES 

eet 

*** BCD COUNT. 

BcocT RMB 2 

HUNORD EQU  —-_BCOCT CONTENTS X 100 

TENONE EQU  BCDCT+1 —s_ +: CONTENTS X 1 

eee = = — ~~ — pmmmwemwcccesccccenscccs 

nee WUMBER OF PULSES COUNTED 

wen 

*©* HYSTERESIS COUNTER. POINTS TO A NUMBER IN THE TABLE THAT IS THE 

wee AMOUNT OF HYSTERESIS PRESENT IN THE SYSTEM. INITIALIZED TO 6. 

HYSTPT RMB 1 

ee 

*** POSITION INCREMENT. CONTAINS A NUMBER, THAT WHEN MULTIPLIED BY 0.001 

ee IS THE NUMBER OF DEGREES THAT THE POSITION COUNTER (BCDPOS) IS 

wee TO BE INCREMENTED OR DECREMENTED DURING PROGRAM EXECUTION. 

ene THE VALUE OF ‘POSINC’, DETERMINED EXPERIMENTALLY, SHOULD BE 

one 7.0652. SINCE THE PROGRAM IS DESIGNED WORK WITH INTEGERS ONLY 

eee THIS NUMBER IS ROUNDED TO 7. TO REDUCE THE CUMULATIVE EFFECT OF 

wee THE ROUND OFF, EVERY 32 COUNTS ‘POSINC’ IS SET EQUAL TO 8. THIS 

wee AGAIN LEADS TO SOME CUMULATIVE ERROR, BUT THE SMALL ANGULAR RANGE 
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240 
241 
242 
243 
264 
245 
246 
267 
248 
249 
250 
251 
252 
253 


255 
257 


258 
259 


001D 


OO1E 
OO1F 


0020 
0021 


0022 


0000 
0080 
0080 


0081 


0085 
0086 
0088 


0080 


AE 10 
7F 
5c 
A3 22 
23 FA 





mee OF THE TILT ANGLE (10.5 DEGREES) ALLOWS US TO NEGLECT ANY FURTHER 
ote MODIFICATIONS. 


tee 


POSINC RMB 4 
ror 


fee HYSTERESIS VARIABLES. USED TO ELIMINATE THE EFFECTS OF BACKLASH OW 


ee THE POSITION MEASUREMENTS. 
wee 

KYsT RMB 1 TWE TWRESHHOLD VALUE DETERMINED . 
re EXPERIMENTALLY. 

HYSTCT RMB 1 CURRENT AMOUNT OF HYSTERESIS MEASURED. 

ane 

*e* STATUS BYTE. USED TO KEEP TRACK OF WHAT IS GOING OM. - 
ete 

STAT Bi CURRENT STATUS. 

LSTAT wf PREVIOUS/LAST STATUS. USED TO KEEP TRACK OF 

owe L_SET ONLY. 


ow 
© TIMER COUNTER. USED IN CONJUNCTION WITH THE TIMER PRESCALER AND THE 
= TOR TO KEEP TRACK OF OME SEC. INTERVALS. USED IN BLINKING THE 
eee DISPLAY. INITIALLY SET TO 31, WHEN THE ‘FLASH’ BIT OF ‘STAT’ 
ave IS SET. TIMCT 1S DECREMENTED EACH CLOCK INTERRUPT (APPROX. 31 
eet TIMES PER SEC). RESET TO 31 WHEN CONTENTS GO TO ZERO. 

eee WHEN (TIMCT)=0 THE DISPLAY WILL TOGGLE. 


TIMCT = RMB 1 


are 
RARARERAREAREREREAHEREERRRRERERREREEEREEEEEREEREAAEAEERREEREERERERRENEEK 


ee * 
oe PAGE ZERO ROM 
ae e 


PRARARERERERREARAREREERAAEEEEEEEEAAERAARRAREARARARAEEERRERERERRRERRAEEEH 
ae 


ee IWITIALEZATION ROUTINE. 
ee . 
es 
CODE 
oe 
ORG ZROM PAGE ZERO ROM. ‘ 
*e 
RELATIVE RELATIVE ADDRESSING MUST BE USED FOR THE BRANCH. 
an 
RESTRT EQU $ THIS IS THE ENTRY POINT WHEN AN EXTERNAL 
abd INTTERRUPT OCCURS. 


atk 
RAARAAAARARARAARAAEAAARARERERERRARRERAAAREERREREERARERERERRAEREREREREREEE 
we 


one INITIALIZE THE PC AND CLEAR RAM. 
he 
een 
SEI SET INTERUPT TO AVOID INTERUPTION ANO 
RSP RESET THE STACK POINTER. JUST IN CASE! 
eee 
LOX @RINCT CLEAR ALL OF THE VARIABLES BETWEEN 
CLRIT CLR Xx *BINCT’ AND ‘TIMCT’ (INCLUSIVE) .NOTE 
TwCX TWAT THIS SETS THE COUNTER AND THE POS- 


CPX STIMCT ITION TO ZERO. THIS MEANS THAT ROTATION 
BLS CLRIT SHOULD START IN AN INCREASING (CW) 


“28 DIRECTION FROM THE MOST CCW POSITION 
nee AFTER A RESET. . 
ene . 

ABSOLUTE BACK TO ABSOLUTE ADDRESSING. 


ene 
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272 
273 
276 
275 
276 


278 
279 


281 


285 
286 
287 
288 
289 


301 
302 
303 


305 
306 
307 


309 
310 
311 
312 
313 
314 
315 
316 
317 
318 
319 
320 
321 
322 
323 
324 
325 


3 338 


o0a0 


O0A2 


QOA4 
OOA6 


00A8 
OOAA 


O0ac 


OOAE 
0081 


Aé 08 
&% 03 
87 20 


1¢ 20 


A6 06 
B7 1E 
B7 1C 


Ab 47 


87 09 


A6é 1F 
B7 22 


1D OA 


c 02 
1c 01 


b8 


RERTRRERAECEEREREREE SESE EEEAE AERA AEEEEE EERE REE AHEAAEAEEEEEREERHEREEEEE 
eee 
ore ESTABLISH 1/0 PORTS. 
een 
LA #1 PORTS A,B,C ARE CONFIGURED AS 
STA —- PORTA*DOR = ALL QUTPUT. PORT D IS ALL INPUT 
STA —- PORTB*DOR = SO _ THERE IS NO MASK TO SET. 
STA —- PORTC+DOR 


wee 
trttrenerererrererteeedereErrrrerNerrrretterereredreNsteerereretrreTEEss 
SET UP THE STATUS REGISTER. 


LDA #%00001000 = -- 


AND —s- PORTD |--> SET UP ‘L_SET’ BIT OF ‘STAT’. 
STA STAT -- 
eee 
BSET  MOD_32,STAT 0 18 MODULO 32. 
we 
SRSA SAAAERAARERAEEAAEAERAEAAATAAHAAA TEESE EEA RES ERE ARARAEREAE RENAE REEEH 
een 
wee INITIALIZE HYSTCT. 
wet 
LDA #06 
STA —HYST 
STA ——HYSTPT 


tee 
SAKA HRAANNATEREKeeeNAEENTANTeAAAeTeNEHKeAerETHENEERTENENEReEHNNNEREEE 
we 

oe SET UP THE TIMER FOR A & MHZ CRYSTAL / 4 = 1 MHZ CLOCK. 

eee 

see NOTE: THE MASK OPTION REGISTER IS IN ROM. IT IS SET UP AT 

wae THE END OF THE PROGRAM. 


nee 
RHARAAEERERRERERERRED SET UP THE TCR. PRARREREARERREEEARAREEEEEEEEARER 
eer 


LDA POITE+BIT2+BITI+BITO 
see (TIM) | CPS2)(PS1) (PSO) 
***(DISABLE INTERRUPT)|(PRESCALE BY 128) 
ee 

STA TCR 


nee 
an 
*** SET UP THE TIMER. 
ane 
LDA #255 1 MHZ/(128*255) = 30.6 (APPROX. 31) 
STA TIMER 


weer 
RRARREERERERERER INITIALIZE THE TIMER COUNTER. RERREEHERAAARERERARERER 
aan 


LDA #31 PROVIDES FOR 1 SEC. BLINK INTERVAL. 


STA TIMCT FOR 2 SEC. INTERVAL JUST USE TIMECT=62, etc. 
oun 


eek 
SEAAAAAAREAEEEARARRAAAEAAEERERAEEAAEAA AAA EREEAERAERAERERRAAEERERERER 
ae 


os SET UP MISCELLANEOUS REGISTER. 


oe 
BCLR 86, MR EWABLES THE SECOND INTERRUPT. 
oe 
HHAARERENHNAN TORRE LEERERETERHRERAeTeRKENEAetEReKENNtERTNENeRERELOHEEEE 
we 
= COUNT = O IS DISPLAYED INITIALLY. 
we 
JSR OUTCT 
BSET POSTIV, PORTB 


er 
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327 
328 


331 
332 


335 
337 
339 


341 
342 


345 
347 


349 
350 
351 
352 
353 
354 
355 
356 
357 
358 
359 


BRERE § 


o0c2 
00c4 


00c8 


oocc 
OOcE 
0000 
0002 


0004 
0006 
0008 
000A 
oooc 


OODE 
O0EO 
00E2 


O0E4 
OOES 
00E7 


00E9 
OOEB 
OOED 
OOE F 


OOF1 
OOF3 
OOF6 


00rs 
OOF8 
OOFE 
0100 
0102 
0104 


0107 
O10A 


9A 


09 03 OB 


06 03 04 
17 20 
20 F6 
16 20 
20 F2 


Aé 40 
87 09 


Ab 08 
B4 20 
B7 21 


B4 03 
Bi 21 
27 15 


B& 20 
87 20 
3c 1E 
3c ic 


B6 1C 
Al 19 
23 05 


“fF 
87 1E 
B7 1C 


Aé 00 
87 00 
Ab CO 
B7 01 


BE 1C 
06 03 28 
B7 02 


09 03 C7 
04 20 04 
1C 04 
20 02 
1D 61 
08 20 05 


@ 02 08 
20 03 








ee 


cul CLEAR THE INTERRUPT MASK TO GET STARTED. 
ove 

RELATIVE RELATIVE ADDRESSING MUST BE USED FOR THE 
eee REMAINDER OF THE PROGRAM. 
een 


SRRRERSEESEEEEEAAEAAAAAEEAAAAERAAAEAN ARETE SAAR RE EEA A TLE RAE EAE EEE EAE Ret 
ee 


** WAIT LOOP. EXECUTES, UNTIL AN INTERRUPT OCCURS. 


eer 

PAUSE BRCLR FUNCT,PORTD,CHHYST WANT TO CHANGE HYST? 

** YES...@0 TO CHHYST. 
BRSET SET,PORTD,SBIT MO... ‘SET,PORTD’ SET? 
BCLR  -L_SET, STAT WO...CLEAR ‘L_SET, STAT! 
BRA ss: PAUSE AND LOOP. 

SBIT  BSET  L_SET,STAT YES...SET ‘L_SET, STAT’ 
BRA  —s- PAUSE AND LOOP. 

ee 


Street eeetererertrererrrereerereerrrErrrenrHerEKerrANe TREN eOreeeee 
ee 

** HYSTERESIS MODIFICATION ROUTINE. PERMITS MODIFICATION OF THE 

** HYSTERESIS BUFFER WITHOUT REPROGRAMMING. 





+. YES... 
CHHYST LDA = #BIT6 DISABLE TIMER INTERRUPT. 
STA TER 
aan 
LDA: #x00001000 SAVE ‘L_SET’ 
AND STAT INTO 
STA —LSTAT ‘LSTAT’. 
LDA ——-#x00001000 
AND —s- PORTD ‘SET,PORTD’ --> ACCUMULATOR 
CMP LSTAT HAS THE SET SWITCH BEEN CKANGED? 
BEQ ——DISPLA 
ee YES... 
LOA = #x90001000 -- 
EOR STAT |-->CHANGE ‘L_SET,STAT’, 
STA STAT -- 
INC —HYST THEN INCREMENT THE HYSTERESIS 
INC ——-HYSTPT POINTER AND ‘HYST’... 
ene 
LOA —sKYSTPT -- 
cP #25 -- 
BLS ——DISPLA -- 
wee -- BUT NOT ABOVE 25. 
CLRA -- THEN--->| 
STA —HYST -- | 
STA —HYSTPT -- 
gee 
DISPLA LDA #x00000000 NO... JUST--------- > 
STA PORTA -- 
LDA: #%11000000 -- | 
STA —- PORTB - \l/ 
one ++ DISPLAY CURRENT ‘KYST’. 
LOX ——-KYSTPT -- 
LDA: TABLE, X -- 
STA PORTC -- 
ore IS ‘HYST’ SETTING COMPLETE? 


BRCLR FUNCT,PORTO,CHHYST NO... KEEP CHECKING ‘SET’. 
BRSET WEGTIV,STAT,SIGN YES... RESET THE DISPLAY. 
BSET POSTIV, PORTB 
BRA DIR 

SIGN BCLR POSTIV,PORTB 

OIR BRSET POSCT,STAT,SHOPOS 


ee 


JSR QuTCcT 
DUNCHG 





392 
393 
39% 
395 
396 
397 
398 
399 
400 
‘ 401 


407 


409 
410 
411 
412 
413 
414 
415 
416 
417 
418 
419 
420 
421 
422 
423 
424 
425 
426 
427 
428 
429 
. 430 
431 
432 
433 


435 
436 
437 
438 
439 
440 
441 
442 


445 
447 


449 
450 
451 
452 
453 
454 
455 
456 
457 





010¢ 


O10F 
0112 
0114 
0116 


0118 


O11A 
0110 
0120 


0122 
0124 
0126 


0127 
0129 
Otec 


0120 
O1eF 
0131 
0133 


0135 
0138 


0139 


013¢ 


O13€ 
0140 


CD 02 E5 


0B 20 04 
A6 07 
87 09 
20 9 


1F OA 


OA 20 10 
09 20 07 
1A 20 


Ab 07 
87 09 


18 20 
CO 02 E5 


Ab 47 
87 09 
19 20 
18 20 


CO 02 08 


0139 
OF O09 OC 
1 09 


3A 22 
27 01 


3 


SHOPOS 


are 


DUNCHG 


_INT 


JSR QUTPOS 


BRCLR FLASH,STAT,NO_INT IF THE DISPLAY IS TO BLINK... 
LDA #B1T2+B1T1+B1TO ENABLE TIMER INTERRUPT ANO RESET 
STA TCR TIMER PRESCALER 

BRA PAUSE PRIOR TO RETURNING. 


se 23222 


MAXIMUM EXECUTION TIME FOR THE REMAINDER OF THE PROGRAM OCCURS 

IF THE COUNTER ROTATES THROUGH ZERO AS THE DISPLAY MODE IS CHANGED 
FROM THE BLINKING MODE TO THE COUNT MODE AT THE SAME TIME THAT THE 
BLINKING ROUTIWE IS CAUSING TNE DISPLAY TO TOGGLE TO SHOW THE 
POSITION IN DEGREES. 


MAXIMUM EXECUTION TIME = 67 + 140 + 618 = 825 CLOCK CYCLES. 


**MODE 
oe 


CHMODE 
oe 


ae 


CHANGE ROUTINE. CHANGES TNE DISPLAY MODE FROM 
COUNT -> POSITION -> BLINKING -> COUNT ->....(ETC.) 
MAXIMUM EXECUTION TIME OF 127 CLOCK CYCLES OCCURS WHEN THE 
DISPLAY MODE IS CHANGED FROM DISPLAYING THE COUNT TO DISPLAYING 
THE POSITION CIN DEGREES). 
IF THE DISPLAY IS CHANGED FROM BLINKING TO A COUNT DISPLAY 
EXECUTION TIME IS 67 CLOCK CYCLES. 


BCLR B7, BR AVOID REPEATED INTERRUPTS. 


BRSET  FLASH,STAT,DIS_CT IF FLASHING, DISPLAY COUNT... 
BRCLR POSCT,STAT,DISPOS IF SHOWING COUNT, DISPLAY POSITION... 


BSET FLASH, STAT _ ELSE, BLINK. 

LDA #BIT2+BIT1+B1TO EWABLE TIMER INTERRUPT AND RESET 

STA TCR TIMER PRESCALER. 

RTI 

BSET POSCT STAT =e 

JSR QUTPOS [-- DISPLAY CURRENT POSITION, AND WAIT. 
RTI = 


LOA #BITG+BIT2+BITI*BITO OISABLE TIMER INTERRUPT AND RESET 
STA TCR TIMER PRESCALER. 
BCLR POSCT STAT ales 
BCLR FLASH, STAT 

~* DISPLAY CURRENT COUNT, ANO WAIT. 
JSR OUTCT 
RTI =< 


RRRAAEEERERAEERERAARERRAEERERAEEERRAREERERERERERAREERRREREEEOEEEUEREENOD 


** BLINK ROUTINE. INTERRUPT ROUTINE TO CHANGE THE DISPLAY FROM POSITION 


TO COUNT OR VICE VERSA EVERY 31 ST TIMER INTERRUPT IF THE 
‘FLASH’ BIT OF ‘STAT’ IS SET. 

MAXIMUM EXECUTION TIME OF 140 CLOCK CYCLES OCCURS WHEN THE 
DISPLAY IS TOGGLED FROM A COUNT DISPLAY TO A POSITION DISPLAY. 


EQU $ 

BRCLR = TIR, TCR, CHMODE IF THE INTERRUPT WAS NOT A TIMER 
INTERRUPT IT MUST BE FROM INT2. 

BCLR TIR, TCR AVOID REPEATED TIMER INTERRUPTS. 

DEC TIMCT IF THERE HAVE BEEN 31 TIMER 

8EQ CHGOIS INTERRUPTS (1 SEC), IT’S TIME TO 
CHANGE THE DISPLAY. 
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0158 
OA 03 01 


OTHERWISE, IT'S BACK TO WORK. 


#31 RESET TIMCT TO 31 (1 SEC. INTERVAL). 
TIMCT 


LDA STAT == 
EOR #%00010000 |-- CHANGE ‘POSCT’ BIT OF ‘STAT’. 
STA STAT o- 

we 


BRSET POSCT,STAT,POSOUT DECIDE ON CORRECT DISPLAY. 


ot 


eeeeeweeenes CHANGE THE DISPLAY TO SHOW THE COUNT..... ‘Swe*teeenerenen 
we 

JSR OUTCT 

RTI 
e 


wesaeeceeees OR HAVE THE DISPLAY SHOW THE POSITION. ‘Seteeteteenerennes 
oe 
POSOUT JSR OQUTPOS 


RTI 
ee 


RAERAAAAAEEREAREREARERARAAEEERERAREEREERAERARAEEERAATERAERRAERAEEERERETEEE 
re 


oe COUNT ROUTINE. 

et WHEN A COUNT IS RECEIVED THIS IS THE ENTRY POINT . 

oe MAXIMUM EXECUTION TIME OF 618 CLOCK CYCLES OCCURS WHEN THE 

as COUNTER ROTATES CCW THROUGH ZERO AND THE POSITION (IN DEGREES) 
* 1S BEING DISPLAYED. 


ee 


CURRENT DIRECTION OF ROTATION IS DETERMINED BY INSPECTING THE STATUS 
OF ‘CH_A’ AND ‘CH_B’. THE FOUR POSSIBILITIES AND THE ASSOCIATED 
DIRECTION OF ROTATION ARE AS SHOW BELOW. NOTE THAT THIS SCHEME 
PREVENTS MULTIPLE OSCILLATIONS ABOUT A SINGLE POINT FROM 

REPEATEDLY INCREMENTING OR ©_. ..4ENTING THE COUNTER. 


wes ee ccwe Pe creme wee wee mm cee wee we wn eee ene ceed 


CHB DIRECTION | COUNT THE PULSE? 


OF ROTATION 


ee wercscecce 


aeeeawee FIRST SEE IF WE ARE SUPPOSED TO COUNT THIS INTERUPT. ‘®*eenee 
te 
COUNT EQU $ 

BRSET CH_B,PORTD,OKCT IF CHB IS LO WE DON’T COUNT THE 

RTI INTERRUPT. 


Seeneeeeeseres TF THE INTERRUPT IS VALID UPDATE ‘STAT’. S#tteneeeecene 
we 
OKCT LDA =—ss@RONNI1111 

AND = STAT SAVE ALL OF THE OLD ‘STAT’ EXCEPT THE 

STA STAT DIRECTION OF ROTATION. 

LDA #%10000000 

AND =: PORTO ‘CH_A,PORTD’ INDICATES THE DIRECTION 

OF ROTATION AND BECOMES ‘UD,STAT’. 
ORA STAT ADD THE RESULTS TO GET 
STA STAT THE NEW ‘STAT’, 


oe 


** DECIDE IF THE “SLACK" DUE TO BACKLASH/HYSTERESIS HAS BEEN TAKEN OUT. 


BRSET UD,STAT,HYSTCK IF ROTATING Cw SEE BELOW. 





HYSTCT ELSE, SEE IF WE DECREMENT THIS TIME. 
cew IF KYSTCT=0, GO TO THE COUNT DOWN 
ROUTINE. 
#1 ELSE, DECREMENT THE HYSTERESIS COUNTER, 
HYSTCT 
AN WAIT FOR THE NEXT INTERRUPT. 


WYST IF ROTATING CW.... 

HYSTCT AND WYST = HYSTCT .... 

Cu COUNT THE PULSE . 

HYSTCT ELSE, INCREMENT THE HYSTERESIS COUNTER, 
AMD WAIT FOR ANOTHER PULSE. 


CLOCKWISE ROUTINE. 


een 
wanenawenawens INCREMENT THE BINARY COUNTER (BINCT). ‘*e#teeenneteneens 


one 
LDA LOBIN BEGIN AY THE LSB OF THE BINARY COUNTER. 
ADD #1 LOBIN = LOBIN + 1 ; CARRY -> C,CCR 
STA LOBIN 


LDA HIBIN 
aoc #0 ADD THE CARRY TO THE HIGH BYTE. 
STA HIBIN 


wer 
ree 
RAREAAHRAAAEREREEE CLR/SET M00_32 APPROPRIATELY. SHAKES HERARAEReKEeee 
weer 
LDA LOBIN If THE LOW FIVE BITS OF ‘LOBIN’ ARE NOT 
AND #%00011111 NOT THEN THE NUMBER ISN’T A MODULO 32 NUMBER. 
BNE NoT_32 


BSET  MOD_32,STAT 


BRA DIRCHK 


een 
WOT_32 BCLR  MOD_32,STAT 
wen 
een 


DIRCHK LDA = HIBIN 
BMI = CWNEG IF HIBIN <0 , WERE ROTATING CW TOWARD 
ane THE ORIGIN. 
are 
BNE  — CWPOS ELSE IF BINCT .NE. 0, 
LDA LOBIN WE'RE ROTATING CW 
BNE  CWPOS AWAY FROM THE ORIGIN. 
ae 
BCLR -NEGTIV,STAT ELSE, WE/VE GONE THROUGH ORIGIN IN CW 
one DIRECTION. CLR NEGATIVE SIGN. 
LOX = #PTR3-- 
CLRIT2 CLR = 4X -- 
INCX --RESET ALL COUNTERS AND DEGRES TO ZERO. 
CPX = #THOUTH-- 
BLS CLRIT2 -- 
BRA POUT UPDATE OUTPUT. 


BSR ADOBCD 
JSR INCPOS 
BRA UPOUT 


susBCD 





0187 
O1BA 


O1Bc 
01BE 
01c0 


01c2 
01C4 


016 


01c8 
O1CA 
O1cc 


O1CE 
0100 
0102 


01D4 
0106 


0108 
O1DA 
01p¢ 
01DE 
01E0 
O1E2 


O1E4 
O1E6 
O1E7 
O1E8 
O1EA 


O1EC 
O1EE 
OTF 


01F3 
01F6 


CD 02 9A 
20 30 


018C 


B6 11 
ao 01 
87 11 


B6 10 
A2 00 
B7 10 


86 10 
2a 18 


Al FF 
26 10 
B6 11 
Al FF 
26 OA 
14 20 


12 


886 Baar 
> 


88 


O1F9 


COUNTER-CLOCKWISE ROUTINE. 
$ 


JSR 
BRA 
ate 
we 
ee 
ae 
ee 
cou = Ey 
oe 
eee 
te 
LDA 
AND 
BNE 
eee 
BSET 
BRA 
eee 
WO_32 BCL 
ete 
eee 
REREARERRRERAEE 
ake 
DECBIN LDA 
SUB 
STA 
eee 
LDA 
SBC 
STA 
wen 
LDA 
BPL 
aee 
cmp 
BNE 
LDA 
cup 
BNE 
BSET 
een 
een 
LOX 
CLREM CLR 
INCK 
cPx 
BLS 
ake 
CCWWEG BSR 
JSR 
BRA 
tte 
CCWPOS JSR 
JSR 
wee 
ene 
ek 


LOBIN aF THE LOW FIVE BITS OF ‘LOBIN’ ARE WOT 
00011111 = ZERO THEN THE NUMBER ISN/T A MODULO 32 NUMBER. 
wo_32 


MOD_32, STAT 
DECBIN 


MOD_32, STAT 


DECREMENT THE BINARY COUNTER (BINCT). ‘***#ewenuannnens 


LOBIN BEGIN AT THE LSB OF THE BINARY COUNTER. 


#1 LOBIN = LOBIN - 1 ; BORROW -> C,CCR 

LOBIN 

HIBIN 

#0 SUBTRACT THE CARRY FROM THE HIGH BYTE. 

HIBIN 

HIBIN 

CCWwROS IF WIBIN .GE. O , WE'RE ROTATING CCW TOWARD 
THE ORIGIN. 

#-1 == 

CCWNEG -- ELSE IF BINCT .WE. -1, 

LOBIN --WE'RE ROTATING CCW AWAY 

#-1 -- FROM THE ORIGIN. 

CCWWEG -- 


WEGTIV,STAT ELSE, WE'VE GONE THROUGH ORIGIN IN CCW 

DIRECTION. SET NEGATIVE SIGN. 

AND SET ALL COUNTERS APPROPRIATELY. 
weTRS-- 
& a? 

-- RESET ALL COUNTERS AND DEGRES 10 ZERO. 

STHOUTH = -- 
CLREM -- 


ADDBCD 
INCPOS 
UPOUT 


suBBCD 
DECPOS 


RARAAARARARARAAEERARARERERERAEEERAEREES EARS RAAARER ARETE SREEREAEREREERE 


at 


** OUTPUT ROUTINE. ROUTINE TO PRINT DATA TO THE OUTPUT PORTS. BY 


ee CALLING THE APPROPRIATE SUBROUTINE.(’OUTCT’ TO OUTPUT THE 
of THE COUNT AND ‘OUTPOS’ TO OUTPUT THE POSITION). 

o 

UPOUT EQU $ 
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BRSET NEGTIV,STAT, MINUS 
BSET  POSTIV,PORTB 
BRA DISCHK 
SET THE NEGATIVE SIGN 
BCLR — POSTIV, PORTB APPROPRIATELY. 


BRCLR POSCT,STAT,PUTCT 


JSR ouTPOos 
RTI 


JSR OUTCT 


RTI 
we 


RRAERERSORE AAA AEAAEAR ERLE E SESE EAAAEAEREAEE EAE EAA EEEAEEHAEAERAEEEHNEER 
feeesrewers SUBROUTINE TO INCREMENT THE BCD COUNTER (BCDCT). **t#eenne 
een 
ADDBCD LDA —CTPTRI 

appt 

cue CsCCTPTR > 99? 

BLS  OK1_—s NO, WE/RE OK HERE. LOOK UP THE FIRST TWO DIGITS. 

sus #100—=s YES... MODIFY THE CTPTR, 

SEC SET THE CARRY, ANO 

BRA OKITA —USE TABLE LOOK UP. 


cic NO CARRY EXISTS IF WE ENTER AT THIS POINT. 
STA CTPTR1 -- 
TAX -- 

-- LOOK UP THE TWO LEAST SIGNIFICANT DIGITS. 
LOA TABLE,X -- 
STA TENONE -- 
BCC NOMO AND CONTINUE ONLY IF THERE WAS A CARRY. 


° 


LDA CTPTR2 
Apc #0 ADD THE CARRY. 
STA CTPTR2 -- 
TAX 
*- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 
LDA TABLE,X = -- 
STA HUNORD -- 


6% 
695 
696 


3 
N 


ett 

woMO «RTS 

ant 
RRAEARAERARRAREREREREEAAEREREREEEAEREEHERRRERAERARAEREREEREREEEERERAERROREE 
seeeees SUBROUTINE TO INCREMENT THE POSITION COUNTER (DEGRES). ***#eee 
akt 

#e* FIRST CHECK TO SEE IF THE BINARY COUNTER HAS REACHED A MODULO 32 
sere = NUMBER. 


rear 


INCPOS BRCLR MOD_32,STAT,INC7 ‘MOD_32,STAT’ SET 7 


aeen 


ges easssssss 


LDA #8 YES ... 
BRA Inc INCREMENT THE POSITION BY 0.008 DEGREES. 
oone 
1nc7 LDA #7 WO ..06 
iwc STA POSINC INCREMENT THE POSITION BY 0.007 DEGREES. 
eres 
et@* ROUTINE TO INCREMENT THE POSITION COUNTER , DEGREES’ ,BY A 
Sees PREDETERMINED AMOUNT, ‘POSINC’. 
gete 
LDA PrRi 
ADD POSINC 
Cup # PTRI > 9? 
BLS OK3 WO, WE'RE OK HERE. LOOK UP THE FIRST DIGIT. 





YES... MODIFY THE CTPTR, 
SET TWE CARRY, AND 
USE TABLE LOOK UP. 


WO CARRY EXISTS IF WE ENTER AT THIS POINT. 


-- LOOK UP THE LEAST SIGNIFICANT DIGIT. 


AND CONTINUE ONLY IF THERE WAS A CARRY. 


ADD THE CARRY. 

PTR2 > 99:7 

WO, WE'RE OK WERE. LOOK UP THE NEXT TWO DIGITS. 
YES...MODIFY THE CTPTR, 

SET THE CARRY, 

AND USE TABLE LOOK UP. 


saeavARs sess easaA 


SSERz25R 


o 
_ 


WO CARRY EXISTS IF WE ENTER AT THIS POINT. 


$38 


-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 


DONE AND CONTINUE ONLY IF TKERE WAS A CARRY. 


PTR3 
#0 ADD THE CARRY. 
PTR3 > 
-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 
TABLE,X -- 
ONEDEG -- 
ween 
DONE 
aan 
ee 
RERARARAAARRHAREEREAARERRARERERERRRAAARARRAREEEERTRREREEAEERERRE REAR REE 
seaeeess SUBROUTINE TO DECREMENT THE BCD COUNTER (BCOCT). ‘eeeeenennes 
nee 
SUBBCD LOA = CTPTRI 
suas CTPTR > 992 
BCC = OK6=—sNO, WE'RE OK WERE. LOOK UP THE FIRST TWO DIGITS. 
ADD =-«#100—=S YES, MODIFY THE CTPTR, AND 
SEC GENERATE A BORROW. 


STA CTPTRI -- 
TAX a 
=> LOOK UP THE TWO LEAST SIGNIFICANT DIGITS. 
LDA TABLE,X = -- 
STA TENWONE -- 
acc COMPLT AND CONTINUE ONLY IF THERE WAS A BORROW. 


aaa 


LDA CTPTR2 

sec #0 SUBTRACT THE CARRY. CTPTR > 99 ? 
STA CTpTR2 -- 

TAX o- 


*> LOOK UP TWE NEXT TWO DIGITS IN THE TABLE. 
TABLE,X °° 
HUWORD -- 


d#aeagss333 








SSAAE SE LSRRSS SS RS RAR ASSES RSRERERSS SSS SSF SIISSRSRSSRKSSIFAZAAAIIIIe 


0299 


O29F 


02A1 
O2a3 


O2A5 
02A7 
O2a9 
O2AB8 
O2AD 


O2AE 
0280 


0281 
0284 
0286 


0288 
O2BA 
o2Bc 
O2BE 
o2co 


02c1 
02c3 


02c4 
02C7 
oeco 


02CB 
o2co 
O2cF 
0204 


02d2 
0205 


0207 


81 


86 14 
80 10 
24 03 
AB OA 


B7 14 
97 


06 03 28 
B7 19 
26 iF 


B6 13 
A2 00 
24 03 
AB 64 


87 13 
97 


06 03 28 
87 18 
26 Ce 


B6 12 
A2 00 
87 12 
97 


Dé 03 28 
87 17 


81 


COMPLT RTS 
woe 


SHRAEREREEEERAEREEERE SENSE EEE eEHERAAEAETEASESRRERERARERAAERERESEEREEOE 


feeeees SUBROUTINE TO DECREMENT THE POSITION COUNTER (DEGRES). **etees 
nee 

fees FIRST CHECK TO SEE IF TWE BINARY COUNTER WAS REACHED A MODULO 32 
eore = MUMBER. 


wees 
DECPOS BRCLR MOD_32,STAT,DEC7 *WOD_32, STAT’ SET ? 
were 
LDA # YES... 
BRA bec DECRENENT THE POSITION BY 0.008 DEGREES. 
osen 
OEC7 LDA #7 WO .oce 
DEC STA POSINC DECREMENT THE POSITION BY 0.007 DEGREES. 
one 


eee ROUTINE TO DECREMENT THE POSITION COUNTER , DEGREES’ ,BY A 
oene PREDETERMINED AMOUNT, ‘POSINC’. 
eene 


LDA prri 

sus POSINC PTRI1 <0? 

BCC OKs WO, WE'RE OK HERE. LOOK UP THE FIRST DIGIT. 
ADD #10 YES, MODIFY THE CTPTR, AND 


SEC GENERATE A BORROW. 
ween 
OKs STA PTR1 -- 
TAX ad 
eene -- LOOK UP THE LEAST SIGNIFICANT DIGIT. 
LDA TABLE ,X o- 
STA THOUTH -- 
BCC DUNSUB AND CONTINUE ONLY IF THERE WAS A BORROW. 
tee 
eee 5 
LDA PTR2 
SBC #0 SUBTRACT THE BORROW. PTR2 < 0? 


Bcc OK9 WO, WE'RE OK WERE. LOOK UP THE NEXT TWO DIGITS. 
ADD #100 YES, MODIFY THE CTPTR, AND 


SEC GENERATE A BORROW. 
Ree 
oK9 STA PTR2 = -- 
TAX “+ 
ee -- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 
LDA TABLE,X -- 
STA WUNDTH -- 
Bcc OUNSUB AND CONTINUE ONLY IF THERE WAS A CARRY. 
ane 
eee 
LDA PTR3 
SBC #0 SUBTRACT THE BORROW. 
STA PTR -- 
TAX -- 
sees ++ LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 
LOA TABLE,X == 
STA ONEDEG -- 
eRe 
DUNSUB RTS 


een 

te 

at 
RRRERAAREARAEREREENERLEREAERAAEREARAREAEREAAEETEAAEEERERARERE SARE AREEEOEE 
ae 


** OUTPUT COUNT (OUTCT). SUBROUTINE TO MOVE THE CURRENT COUNT (BCOCT) 


oe TO THE OUTPUT PORTS. REMOVES THE DECIMAL POINT FROM THE 
sai DISPLAY AND BLANKS ALL BUT THE LEAST SIGNIFICANT DIGIT. ALSO 
ee SETS THE MINUS SIGN IF APPROPRIATE. 


ee 
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SSeS S FSR FSS SS SAZASSSSILSRZSSSSSESRSRRSSESISSISSSS SE SSKERECSESLS RSE 


0208 
O2DA 


O20c 
O2DE 


020 
O2E2 


O2E5 
02E7 
O2E9 
O2EB 
O2ED 
O2EF 
O2F1 
O2F3 
O2F5 
02F7 
02F9 
O2FB 


O2FD 
O2FF 
0301 


0302 
0304 
0306 
0308 


030¢ 
O30€ 
0310 
0312 


0314 
0316 


0318 
OSA 
O3ic 


0310 
O31F 
0321 


0323 


86 18 
87 02 


B6 1A 
87 00 


1€ 01 
19 01 


81 


B6 19 
Ai 05 
25 2 
Bé 18 
a4 09 
Ail 09 
26 1D 
86 18 
Al 99 
27 04 
AB 07 


Rs 


SN SRSERKARE BRS 
LSae=Qraussr 


N@ 
Re 8&8 


S3& &5& 


835 


qurcrT Ew $ 
ee 
LDA TENONE 
STA —-PORTC 
ee 
LDA = NUNDRD 
STA PORTA 
ee 
BSET  DECPT, PORTS 
BCLR BLANK, PORTB 
2a 
ats 
ee 
SRTHAAAEAAAEAEARERRRAERAEARAAEAR RETREAT ERRAAREE AREER EAE SERRE ERRAAERERER 
oe 
** QUTPUT POSITION (OUTPOS). SUBROUTINE TO MOVE THE CURRENT POSITION 
COUNT (BCDCT) TO THE CUTPUT PORTS. TWE DECIMAL POINT IS 
DISPLAYED , AMD ONLY THE MOST SIGNIFICANT DIGIT IS BLANKED. 
ee 
GuTpos EQU S 
ee 
LDA = THOUTH-- 
op |S -- 
BLO. —- TRUNC -- IF 5 > “THOUTH! SIMPLY TRUNCATE THE 
LDA RUNOTH -- DISPLAY. OTHERWISE... 
aw CUD -- IF THE LAST DIGIT ISN’T A NINE IT IS 
cr -- EASY TO ROUND UP. JUST ADD A ONE. 
BNE DECIMAL -- 
LDA ss HUNOTH -- BUT IF THE LAST DIGIT IS A NINE CHECK TO 
cup 899 -- SEE IF IT'S 99. IF SO IT GETS GRIM. 
BEQ «UGLY -- 
aoa? -- IF THE NUMBER IS X9 AND X .NE. 9, THEN 
BRA —-PCOUT -- JUST ADD SEVEN TO ROUND UP. DUE TO 
‘. -- WEXIDECIMAL. 
* -- IF THE LOW TWO DIGITS ARE BOTH WINES 
UGLY LDA #00 -- AMD WE WEED TO ROUND UP.... 
STA PORTC «= ->-——s WAKE THE LOW TWO DIGITS BOTH ZEROS 
SEC -- AND SET THE CARRY. 
of 
LDA = ONEDEG -- CHECK THE LAST DIGIT AS BEFORE. 
a OD -- TF USING THIS PORTION OF THE CODE 
op | OU -- THERE HAD TO BE A CARRY. 
BNE =—-NEXT -- IF THE LAST DIGIT 1S A NINE DO THE 
LOA ONEDEG -- CARRY HERE. If WOT USE THE ADC 
apt? -- INSTRUCTION TO TAKE CARE OF 17 
BRA PAU BELOW. 
DECIMAL LDA = HUNDTH -- 
ADD oat -- 
“ -- THIS IS ALL THAT NEEDS TO BE DONE IF 
STA PORTC, «= ---——s THE LAST DIGIT IS NOT A WINE. 
BRA NEXT ~~ 
ee 
TRUNC =LDA = HUNDTH-- 
PCOUT STA PORTC: «= --_—sOAND IF THERE IS NO CARRY IT’S EVEN EASIER. 
ae cic 
WEXT LOA —ONEDEG 
ac | #0 
PAQUT STA PORTA 
ee 
BSET BLANK, PORTS 
BCLR —_—DECPT, PORTB 
ee 
RTS 
ae 


RARAESEAEAAAEREEEREAAAAEAARAAARAAAARAA TERRE AEA BERS AARERRERERARERRAREEREE 
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#88283 8 § & K88888 


SILSFRSFSFERSERIIRIZALIE SSSR RSR SES SIG 


0332 
0337 


0341 
0350 
0355 


O3SA 
OSSF 


0373 
0378 
0370 


0387 


038C 


OF38 
OF38 


OFFS 


OFFs 
OFFA 
OFFC 
OFFE 


1000 


SSASAAGSASSESERSERSaAsRs 
ROKSHKIFSELSELESKVSLKS 


07 


0139 
0158 
0158 


SESRANSEYRAKSRNBABSS 


SASRAASARUEGSARKSABS 


SRSRIFSKSKSESEBLSESR 


Lines Assembied : 


et 


** SET UP THE TABLE TO BE USED WITH BCD INCREMENT/DECREMENT ROUTINES. 


re 
® 
2 


TABLE 


* 
® 


ENDS 
DATA 
FCB 
FCB 
Fcs 
FCB 
Fes 
FCB 
Fca 
Fcs 
FCB 
FCB 


ENDS 
CODE 


$00, $01 , $02, $03, $04 , $05 , $06, $07, $08, $09 
$10,$11,$12,$13,$14,815,$16,817,$18,819 
$20, $21,822, $23, S24 , $25 ,$26, $27,828,829 
$30, $31 , $32,853, $34,935 ,$36, $37,838,839 
$40, $41, 842,843 , $44 , 845 , 846,847,948, 849 
$50 $51, $52,853, $54,855 856,857,858, 859 
$60 , $61, $62 , $63 , $64 ,865 , 866, $67,368, 869 
$70,871 ,$72,873, 876 ,$75 $76,877 ,$78,$79 
$80 , $81, $82, $83, $84 ,$85 , $86,387, $88, $89 
$90 ,$91 , $92, $93 ,$% , $95 ,$96,$97,$98, $99 
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SET UP MASK OPTION REGISTER. 


ABSOLUTE JUST TO ENSURE THAT THE INTERRUPT VECTORS 


ARE CORECTLY LOCATED. 


ORG WOR 

FCB MBIT2+BIT1¢BITO 

COMMENTS; 

BIT 7 CLOCK SOURCE O = CRYSTAL. 

BIT 6 TIMER OPTION O = INTERNAL. 

BIT 5  TIMER/CLOCK SOURCE O = INTERNAL. 
BIT 4 NOT USED. 

BIT 3 NOT USED. 

BIT 2 SET - 

BIT 1 SET ~ PRESCALE SELECT 111 => 128 
BIT 0 SET - 


REARRAAERAAEAARAEARAAAAARRARRARRREESEREREER TERE OEE E EEK EHEREEERHERREREE 
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Fos 
Fos 
FOS 
FOB 


ASSIGN INTERRUPT VECTORS. 
INTRPT 
BLINK TIMER/INT2 INTERRUPT VECTOR. 
COUNT EXTERNAL INTERRUPT VECTOR. 


COUNT SOFTWARE INTERRUPT VECTOR, NOT USED. 
RESTRT RESET VECTOR. 


Assembly Errors : 0 
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